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ABSTRACT 

The continuing decrease in the cost of microprocessors 
as well as an increase in their capabilities has resulted in 
dedicated, on-line digital controllers becoming more 
attractive. 

A microprocessor based on-line digital controller is 
described. For analog control it features the standard PID 
and D(z) controllers, along with two other novel control 
algorithms. For digital stepper motor control there is a 
direction output and a pulsed output. Both position and 
velocity algorithms are implemented for the stepper motor 
controls) Theycontrollervisidesigned for ease of use so that 
sanpled-data controllers may be conveniently studied without 
extensive knowledge of computer programming. 

The instrument features sampling periods from 10 msec 
to 30 seconds. The coefficient magnitude range is from 
0.000001 to 999. The control algorithms and coefficients are 
eaSily changed by keyboard entry. The controller can be used 

ith either an internal or externai set-point. 

Simple digital filters can also be implemented on the 


device. 
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1. Introduction 


Soon after the development of the digital computer it 
was recognized as a powerful instrument for implementing 
control systems. The digital computer can not only implement 
the control algorithm, but it can also easily check the 
system for overloads, keep a log of the plant which is under 
control, and even optimize the control aigorithm. More 
complicated control algorithms can be implemented on a 
digital computer than is practical with hardwired 
controllers. 

Another important advantage of using a computer as a 
controlier is the advantage of digital control. The 
parameters of a digital controller are stored as words in 
memory locations and are therefore not subject to variations 
due to age or temperature. The digital controiler is 
adjusted for the specific plant under control and need only 
ke readjusted if the plant changes. 

Due to these and many other advantages computers began 
to be used for on-line control in many industries. A major 
disadvantage was the high initial cost of a large computer. 
In order to spread the cost the computer had to be used for 
other business functions as well as plant control. Book 
keeping programs would use the computers process time and 
make less time available for running time-critical control 


algorithms. 
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Another disadvantage was using only one computer in a 
plant to run all of the control loops. if then the computer 
operation failed, all loops were without control. 

A far better solution would be to have a dedicated 
computer for each control loop. The introduction of 
mini-computers was a step in this direction. Many minis 
could be purchased for the cost of one large installation. 
For many processes, however, the advantages could stiil not 
justify the cost. 

The development of micro-computers and the sharp 
decreases in their cost has now made dedicated digital 
controllers attractive and economically practical. 

As digital controllers become more common, it is 
important that electrical engineers have a basic 
understanding of digitai sampled controllers. Undergraduates 
are capable of understanding the theory of digital controi! 
and need only the experience of designing and measuring some 
digital control algorithms. The drawback in the past has 
been the requirement of a large programming effort on the 
part of the student. What is needed is a calculator like 
device that can perform digital control algorithms, with the 
various coefficients entered from a keyboard. This approach 
allows the engineer to treat the controller as a black box 
with a transfer function that he can select by keyboard 
entry. 
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1 Martens, "IEEE Transactions on Education", Vol. E-11, No. 
4, Sept. 1968 
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A device of this black box nature is also useful for 
experimenting with different digital controllers in the 
laboratory. The dead-beat, or ripple free minimal tine 
response, controller can be easily implemented and the 
effect of control or plant parameter changes observed. Other 
novel control algorithms, such as automatic switching 
between dead-beat and PID, can be conveniently studied in 
the laboratory. 

A digital controller which has analog inputs and 
outputs can also be used as a digital filter. Digital 
filters are very useful for low frequency use, as there are 
no eannea tare or inductors which would become prohibitively 
large for very low frequency use. Since the digital filter 
tuning is done by constants contained in memory a digital 
filter is easily duplicated, with no manual tuning needed. 

Signal conditioning of very low frequency signals is 
often needed in biological research. The digital filter is 
very useful in this application. 

This thesis describes the design of a useful calculator 
like digital controller. The device was developed to meet 
the foliowing objectives. 

1) Standard +10 volt analog ranges, with a 
resolution of 12 bits (4.88 mV) 

2) Single input and output 

3) No extensive user programming ability required 

4) Coefficients easily entered from a keyboard, and 


displayed on a digital display 
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9) 


6) 


7) 


8) 


9) 


10) 


11) 


Controller algorithm selected from the keyboard 
Sampling rate selected from the keyboard 
Sampling rate as fast as possible to widen the 
useful digital filter range 

Useable with internal or external set point 
Derivative control turned off for set-point 
change in the PID control mode (bumpless 
transfer) 

Use a minimum of memory (less than 4k of progran 
storage, and 1k of random access storage) 
Position and velocity algorithm for stepper 


motor control 


Described iS a micro-processor based black box 


controller which is useful for laboratory digital control 


experiments. 


Several different controller types were 


programmed into the digital controller. The following 


control algorithms were implemented and tested. 


1) 
2) 
3) 
4) 


>) 


6) 


Standard PID controller 

D(z) type controller 

Positional stepper motor control 

Velocity stepper motor control 

A dead-beat controller which uses a look-up 
table to output the control whenever the 
set-point is changed, and otherwise runs in the 
PID mode 

Same as the above but using D(z) for the 


dead-beat response 
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The above two last control algorithms were investigated 
with noise added into the control loop. They were also 
tested in their response to changes in the controlied piant 


parameters. 


2. System Implementation 


As seen in figure 1, a digital sampled control systen 
consists of a sampler, an analog to digital converter (A/D), 
the micro-computer, a digital to analog converter (D/A), and 
a first order hold circuit. The plant transfer function G(s) 
can be implemented on an analog computer. 

The configuration of the system actually developed 
differs slightly from this. The sampler does not exist 
externally as a separate circuit element, but is contained 
implicitly in the computer. The sampling operation is 
performed by the computer reading the A/D periodically. 
Another difference is the hold circuit which does not exist 
aS a separate circuit element following the D/A. Instead the 


D/A converter is driven from a latch, which results in the 
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same effect as the hold circuit after the D/A. The final 
difference is the error signal subtraction. This operation 
is done internally in software after the A/D instead of 
before it. Thus the value read by the A/D is C and not R - C 
as in figure 1. 

As seen in figure 2, the controller is normally used 
with its internal set-point. The controller can be used with 
an external error subtractor by simply leaving the internal 
set~point set to zero. Note that this introduces a sign 
change into the control algorithms since the A/D sample is 
subtracted from the set-point. The practical digital 
controller requires various blocks in order to be functional 
and convenient to use. The main hardware blocks, seen in 
figure 3, are the keyboard, the micro-processor, the A/D 
converter, the D/A converter, the timing generator, and the 


digital display. As well, the processor requires memory, and 
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power. There are two types of memory in the systen, 
read/arite random access memory (RAM), and read-only progran 


memory (ROM). 


2-2 The Hardware 
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Fig. 3 Controller Hardware 
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It was decided to use a commercial micro-computer board 
as the central block of the system. This board was chosen as 
it contained the necessary circuit elements for the 
processor part of the controller. The A/D and D/A converters 
and the timer circuit were added on another board. The 
processor board choseh is a product of Motorola and has the 
following main features. 

1) MC6800 micro-processor integrated circuit (IC) 
2) 48 Input-Output lines (10), and 12 IO control 

lines to be used for the D/A and A/D converters 
3) 1024 words of RAM 


4) Sockets for 4096 words of ROM 


The ROM's used for the program memory are 1024 by 8 
bits in size, and are eraseable by exposure to short wave UV 
radiation. This is a convenient memory to use for progran 
development. It is non-volatile so that the memory remains 
after the power is removed, but it can eaSily be erased for 
program changes during the operating system design. The 
complete operating system for the digital controller fits in 
less than 3k of ROM. 

The 1024 words of RAM included on the micro-computer 
koard are more than sufficient for the operating system 


requirements. The highest addresses are used by the system 
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for a push-pull type stack, also called a last-in-first~-out 
buffer (LIFO). This structure is useful for saving the 
return address of a subroutine call as well as intermediate 
results of calculations. The stack structure is also used to 
save the processor register values and return address oa an 
interrupt. This allows reentrant routines to be used. For an 
example see the multiply routine described in the software 
section. 

The lowest addresses are used as fixed address data 


storage locations by the various subroutines in the systen. 


2-2-3 Analog and Digital Conversion 

Since the desired resolution of the system was 12 bits, 
compatible 12 bit A/D and D/A units from Burr-Brown were 
chosen. This number of bits results in a very low level of 
quantization noise. These converters feature bipolar outputs 
to give the +10 volts and are complete, requiring a mininun 
of external components for operation. 

These converters can be wired to use twos complement 
binary numbers. This number system is convenient for the 
mathematical routines used in the controller systen. 

The micro-computer board contains 6 - 8 bit 10 ports 
along with 24 IO control lines. Two of these 8 bit ports are 
used as the input to the D/A converter. These port lines are 
latched and therefore serve as the first-order hold circuit. 


Another two 8 bit ports are used to read the result of an 
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analog to digital conversion from the A/D. One control line 
is used to start the A/D conversion, another control line is 
used to signal the completion of the ccnversion. 

Note that in order to maintain the accuracy of the 12 
bits analog and digital conversions it is necessary for the 


8 bit CPU to perform caiculations in double precision. 


A Motorola MC6800 compatible timer IC (MC6840) was 
chosen to generate the sampling time intervals. This IC 
contains 3 separate 16 bit counters which are easily 
controlled from the system software. 

One of the 16 bit counters is preset and used to divide 
the 1 MHz system clock to 1 ms pulses. Another one of the 
counters is then used to ccunt the 1 ms pulses to generate 
the desired sampling interval. This resuits in a sampling 
time resolution of 1 ms. The output of this counter is also 
used to generate sampling interrupts to the processor. 16 
bits could be used to count to 65.536 Seconds, but it was 
decided to limit the maximum time to 30 Seconds. This is not 
felt to be a limitation as there are few applications for 
sampling times Longer than 30 seconds. 

There is also a lower limit of 10 ms on the sampling 
time. This limit is due to the time required by the systen 
to perform the control calculations. 


The third timer is used for the stepper motor control. 
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Depending on the control mode this timer is used either as a 
variable frequency generator or to output a predetermined 


humber of pulses at a given rate. 


2-2-5 Keyboard and Display 


To simplify the interface to the keyboard and the 
digital display unit, it was decided to use the INTEL 8279 
display and keyboard interface IC. This IC contains most of 
the electronics for reading a keyboard and controlling a 
digital display. 

The keyboard is a 4 by 6 matrix, divided into function 
keys, nhumber keys, and a master reset button. Their 
operation is fully described in the appendix. 

All coefficient values are entered into the system in 
normalized scientific notation, with a 3 digit mantissa and 
aone digit exponent. This requires 6 digits for the 
display, which is also sufficient for error messages. 

Seven-segment displays were chosen to display 
coefficients, sampling times, control modes, and other 
information necessary for the user of the digital control 
systen. The appendix contains a complete users guide to the 
controller. The guide gives the necessary information for 
loading coefficients, selecting control modes, etc. It also 
defines the various error messages that the system displays 


due to attempted illegal operations. 
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2-3 The Software 

Since the digital controller must output the new 
control value as guickly and as close to the correct time as 
possible , the actual control program is interrupt driven. 
The timer chip generates interrupts to the computer 
periodically, and the control program is called to take the 
input sampie and calculate the control output. This 
interrupt has the highest priority, and takes precedence 
Over any other operation. A second source of interrupts is 
from the stepper motor control. When the velocity aigorithn 
has calculated a number of steps for the motor a counter is 
loaded. This counter causes interrupts at the stepper pulse 
rate and is decremented at each interrupt until it is equal 
to zero. When the micro-processor is free from a control 
interrupt it checks the keyboard to see if any keys have 
been pressed. If any button have been pressed, the proper 
action is taken. 

The operation of the function and number keys is 
described in the appendix. The appendix also contains flow 


charts for the controller system and the source code for the 


program. 


2-3-1 Restart Program 


On either power-up or a master reset the initialization 
routine is called. This routine performs the following. 
1) Initialize the RAM 


2) Clear the display 
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3) Turn off the sample timer 

4) Set stepper pulse rate to 10 ms 

5) Initialize the D/A port as outputs 

6) Initialize the A/D port as inputs 

7) Output QO on the D/SA 

8) Select PID mode with external set-point 


9) Wait for commands from the keyboard 


2-3-2 Foreground Program 

Following system initialization the program goes into a 
loop waiting for buttons to be pressed. When a button is 
pressed the 8279 IC debounces it and puts its row and column 
into a first-in-first-out buffer (FIFO). The program checks 
this buffer and when a button is found it reads it and 
compares its location with a table entry. If the button is a 
number button and no function has previously been called 
that is expecting a number as an operand, it is translated 
into seven-segment form and written out to the digital 
display. If it is a function button, it is used to index a 
table of system subroutines and the corresponding one is 
called. If another function button is pressed while a 
previously called function is waiting for a number, an error 
message is put onto the display. All function formats and 
error messages are described in the user's manual, found in 


this thesis. 
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223-2-1 Fast Multiply Progran 

It was decided to perform the multiplications needed by 
the controller programs in the system software. There is 
hardware available to perform the floating point operations 
required , but the cost is high. Floating point calculations 
are necessary in order to make the controller a useful 
laboratory device. 

This choice creates a constraint on the system since 
available floating point software reguires 10 ms to perform 
a multiplication. Since the input value, and the output 
value are 12 bit numbers, only the ccefficients need be in 
floating point form. This introduces some freedom into the 
multiply program and it does not need to produce a 
normalized floating point result, only a 12 bit binary 
number. With this freedom, the muitifly routine can be 
speeded up. 

The format used for storage of floating point numbers 


is shown in figure 4. Bit 7 of byte 0 is the mantissa sign 
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bit. Bits 6-0 are the exponent in 2's complement form. The 
next two bytes are the mantissa, consisting of 4 hexidecimal 
digits, in unsigned form. The mantissa can range from 0.0000 
to O.FFFF, and the exponent can range from -64 to +63. In 
decimal the coefficient magnitude can thus range from 8.64 
EXP(-82) to 7.24 EXP(75). This range is far larger than is 
required for practical use due to the limited resolution of 
the D/A and A/D. It will therefore be reduced to ailow for 
easy conversion from decimal to hexidecimal form, and also 
to speed up the multiply routine. 

The D(z) transfer function implemented is particularly 
sensitive to arithmetic noise. This noise comes from 
quantization of the analog input and output, roundoff of 
results, and guantization of coefficients. The arithmetic 
routines will handle 16 bits, 4 more than the D/A and A/D. 
This "temporary overflow property" minimizes the danger of 
overflows occuring in intermediate calculations. This is 
especially important for D(z) calculations where the 
internal magnification could cause overflows. 

The multiply program is written to take a 16 bit 2's 
complement binary number, multiply it by a floating point 
hex number, and produce a 16 bit 2's complement binary 
number. If an addition or muitiplication were to overflow 
there is a possibility that a limit cycle couid occur in the 
D(z) function. This is avoided by saturation arithmetic. On 
any overflow the result is set to the maximum value. 


The system reduces the final output number to 12 bits, 
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as the D/A and A/D will not accept any more bits. Overflows 
will cause the output voltage to saturate at +10. The systen 
program insures this by detecting overflows after arithmetic 
operations and setting the result to its maximum value. The 
flowchart for the multiply routine is in the appendix 


section on flowcharts. 


2.3.2.2 Decimal to Hex Conversion 


As controller coefficients will normally be calcuiated 
in decimal by the user, the system must accept floating 
point decimal and translate it to the internal floating 
point hex notation. Numbers are entered into the controller 
display in normalized scientific notation. The fractional 
Hantissa contains three digits plus a sign, and the exponent 
is one digit plus the sign. 

is€. + .mnn + (exp) Where nnn is the fractional mantissa 
and (exp) is the exponent digit. Note that the + sign is 
not displayed. 
The decimal to hex program will accept mantissas from .001 
to .999 and exponents from -3 to +3. This number range is 


sufficient for practical use of the digital controller. 


There are several other subroutines required by the 
controller. 
1) 7 segment to binary translation, used for 
loading coefficients read from the display 


2) Binary to 7 segment translation, used for 
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displaying numbers 


3) 16 bit 2's complement add program 


e3-3 Controller Routines 


All controller programs are interrupt driven and forn 
the background program. An interrupt to the processor is 
generated at each sampling instant. The system first starts 
the A/D conversion. After the A/D conversion is completed it 
is subtracted from the set-point and stored in memory for 
the control algorithm. The program then jumps to the 
subroutine for the selected control mode. (See the flowchart 
in the appendix) The development of the control subroutines 


is detailed in the next chapter. 
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3. Control Mode Implementation 


The digital controller has its own internal setpoint, 
or as mentioned before, an external setpoint and subtractor 
carn be used. The system subtracts the A/D result (E1) from 
the setpoint in memory and then performs the selected 
control mode calculations. The result of the calculations is 
output to the D/A. 

This digital controller is designed to be used in the 
series control mode. The controller is cascaded with the 
plant, and the output is fed back to the controller input. 
This configuration is seen in figure 2. If desired, however, 
the controller can also be used in the parallel form as a 
feedback controller. In this case an external error 
subtractor must be used. Note the sign change through the 


controller when the internal set-point is not used. 


In analog plant control applications the PID 
(proportional-integral-derivative) controller is well known. 
While it is normally implemented using analog techniques, it 
can easily be programmed into a computer controller as a 
discrete PID algorithm. The digital PID controller is shown 


in figure 5. 
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The output of the PID is given by, 
E2(k) = Kp ey CK) EK S5(K) + Kd & 4K) 
Where the components are, 
PEOPOEtLTONnal*part) Go (Kk) = e | (k) 
integral part, €5 9(k) = en Ak- 1) TET WICK) 


Derivative part, enya ie cm (Kj <i tele 


| 
At each sampling instant these calculations are 
performed and the control is output. The maximum time delay 
from the sample to the output is 3 ms. 
In this form the derivative term is extremely sensitive 
to input noise. To reduce this an averaging technique is 


applied to the derivative values by taking the present and 
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the previous three derivative terms, adding them and 
dividing by four to produce the actual derivative term which 
is used in the output summation. 

The integral term is also sensitive to noise and 
quantization errors, but due to the closed lcop nature of 
the system these errors will tend to zero in the limit. 

In the chapter on controller tests photcgraphs are 
Shown illustrating the PID elements for different sampling 


times and gains. 
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The D(z) control algorithm is natural to the computer 
due to its discrete nature. D(z) transfer functions can be 
Pound f£orelilDeclementseaby taking the sz-transtoum. An 
interesting use of the D(z) controller is to implement the 
dead-beat or ripple free minimal time response controller. 
The design of such a controller is discussed in the 
controller design chapter, section 4.2. 


The D(z) transfer function takes the following form. 


The discrete transfer function can always be put into this 


normalized form. The condition for realizability is that 
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There are five forms in which the D(z) transfer 


function can be realized. Each form has disadvantages and 


advantages, 


which must be weighed for each use. It is thus 


difficult to say that any one form is always the best. 


The forms are; 


1) 
2) 
3) 
4) 


5) 


Direct non-recursive 
Direct recursive 
Direct canonic 
Parallel canonic 


Cascade canonic 
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previous outputs are used in the calculation of the new 


output at a sampling instant. This is the case if all of the 
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b's in the transfer function are zero. If any one of the b's 
are non-zero then the function is recursive, and previous 
output values are used to find the new output. 

The first two realization forms require «aore storage 
and more calculations than the canonic forms. The direct 
carnonic form has the advantage of providing the new control 
output after one subtraction, one multiplication, and one 
addition. The remaining calculations can be done after the 
present output, but before the next output is required. This 
is a definite advantage in our system Since the calculations 
are done in software and the output to the D/A has to occur 
as soon as possible after the sampling time interrupt. 

The direct canonic form has the disadvantage of being 
sensitive to arithmetic roundoffs and guantizations. In 
particular, the poles of the function can move such as to 
make a stable system unstable. 

e.g. If a 3 bit binary system tried to represent a poie 
at 15/16 it would be rounded off to 1. This occurs since 
3 bits can only represent 7/8 or 1. in the z-domain a 
pole at z=1 is an integrator and therefore the system 
might become unstable. 
This effect is especially bad for large order systems and 
this is the reason that the direct canonic form is not used 
in general for digital filters. It is not deemed to be a 
serious problem in our system since the system order is 
limited to 3, and also since the arithmetic routines have 


four extra bits compared to the D/A and A/D converters. 
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four extra bits compared to the D/A and A/D converters. 
Information and examples of noise problems in digital fiiter 
systems can be found in an article in EDN@. 

To program the direct canonic recursive form first 
multiply the numerator and denominator of the transfer 
function by a polynomial X(z). Then separating the numerator 
and denominator we have, 

B2kZ)e= (anti a) zy) + ie. ot ance) xX (Zz) 
and 
BRC GN fy Dizon toca set b 2") X(z) 
Rewriting the denominator, 
MHZ at (2 b,)z-? eT CAN a Ree b 27" X (z) 


The polynomial X(z) can be written as; 


x (Zp =z tr X.Cz) 
SNC) = Ze Suen 2) 
Xen) eee z—-"¥ (gz) 


Since the operator z-1 represents a time delay, all 
calculations involving z~1! can be done after the control 
output. Defining, 
= + + eee + a x 
G aj, X)+ a5X, ae 
and 


Heizs = &Dy X) ait Dh rete ee = Sree 


The calculaticn performed at the sampling instant then 
293.) Jesbeon ana S. C. Bass, “Designers Guide to; Digital 
Filters",EDN, June 20, 1974 
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becomes, 
x eee =. a 
and the output is calculated fron; 
E2 = a, X tG 
Gand Hare calcutated after the control °isvoutput torthe 
D7Ke 
Enersignal=elowagraph rorsthe direct canonmceLornme.s 


Shown in figure 6. 


3-3 Dual-Mode Controllers 

An interesting controller type to investigate is one 
which attempts to combine the advantages of the PID control 
with the fast time response of dead-beat ccntrol for quick 
set-point changes. This controller would normally operate in 
the PID mode to give good plant control and noise rejection. 
PID control is also less sensitive to plant parameter 
Variations than the dead-beat type. 

This control mode can only be used with the internai 
set-point Since it must be known when a set-point caange 
occurs. The controller switches over to the dead-beat 
routine when a set-point change is entered from the 
keyboard. The sampling time is also changed since the 
dead-beat controller would normally require a longer 
Sampling period than the PID controller in order to restrict 
the magnitude of the control signals. 

For a step input, the dead-beat response can be 


completed in N sampling periods, where N is the order of the 
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intervals the controller switches back to the PID control 
and its original sampling time. 

If the plant does not contain a free integrator, it is 
necessary that the controller contains one in order to 
eliminate steady-state error. A PI controller will therefore 
have zero steady-state error. In order for the dual-mode 
controller to properly switch back to the PID mode after a 
dead-beat sequence, it will be necessary to load the last 


output into the controller integrator. 


e1 Dual Mode with D(z) 

When operating in this mode the dead-beat response is 
implemented with the D(z) transfer function. The 
coefficients are calculated according to the derivations in 
the part on controller design or by a computer program on a 


larger machine. 


3.3.2 Dual Mode with Table Look-up 


The dead-beat response can also be accomplished by 
simply outputting N control steps, one at each sampling 
instant. These steps are contained in the computer memory 
and are output by the program at each sampling instant. This 
method has the advantage of not being affected by any noise 
in the loop, but the effect of plant parameter changes may 
ke greater due to the lack of feedback during the N sampling 
intervals. This controller was also tested and the results 


are given in the chapter on controller tests. 


ak 3% stosnxpabint coat 
od atsb10 at eae 
ssoteredt Iiiv “<b siial aad , 
af _ 
shbow={s0b ed¢ 208 29b20 at .203%8 pice 
6 29%2%o-ofoe aan silt of 126d dodiwa. eiseqor9.¢ it fa 
: me 


tesf edf Seol oF ¥iieaeepen aa Thy 4h .sorseooe # 
ssoaeayonak a Ltextnos os ost i es o 


° -& ¢ 
a 


« 


co at or ran ey. 
A \aome otete 


i] 


far ae aoe tod ‘te ix 
2 qnqegs Ieod-bseb aA? eben shat oad oa 161999° oll 
ad? .wodconyd wetetes? (sd gd? dviw baraawel 


ba 
: 


‘t etoissvixzed adt oF patbaoavs hot sluolao 935 asnetot 


io BeiIpVay 


’ 
‘4 bodailgeosos od ones aad sacogase1 tsed~bssd bed ae) 
pulfquee dose ta oto yeqgete toizao @ patssuqemo yte qn ki a 


i> Bab 
" 5 


gioses zesaqnon act ae fagieseoo 915 eqota saodT a sank 


»#) 


ce 
a 


DB 


dv -toetant paiiquae Aose te aexp074 edd td ae * 16 
3etts vasat Biers io apatusvbs oat aad Bos 


gaioa yas ya f 
\ Ales 
ved eepaads 79s oR81B4 tuahy 20 Joutas ed3 tue “vaoe - 


pallqune \ oid Eabuwh ine bao®. a6 ‘wont of? asa ~~ a — 


etivesr sit Bae Detastd obi eau weHtoraa0> 


1 


27 


The stepper motor is a useful device in digital 
controllers. With each pulse the stepper motor advances 1 
step. Since the motor does not move in case of power 
failure, it can be advantageous to use a stepper motor for 
the plant actuating signal. The assumption made is of course 
that the failure mode will not result in pulses to the 
motor. If the controller fails the inputs will remain at 
their last position, and unless the plant contains a free 
integrator it will not drift far from its operating point. 
It is also necessary to provide a direction signal for the 
motor in addition to the drive signal. 

The stepper motor used here is a PHILIPS model 
K82701-P2, having a 7.5° step and a maximum speed of 200 
steps per second. The interface from the controller to the 
stepper motor is simplified by the use of a PHILIPS stepper 
motor driver IC, SAA1027. This IC has pulse and direction 
inputs, and outputs to control the motor. 

There are several ways to use stepper motors for 
control. One common method is the position control used in 
x-y plotters etc. The position is fed back froma 
potentiometer and compared with the desired position. The 
difference is the error signal and it is used to send pulses 
to the motor. The larger the error the higher the pulse 


rate. 
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The stepper motor can also be viewed as an integrator 
and thus can be used to perform the D/A conversion for plant 
control. One advantage as mentioned before is that the 
control value is held in case of controller failure, or 
power failure, unless, of course, the failure results in 
continuous pulses to the motor. The control output is 
Changed by sending a number of pulses to the motor, as 
opposed to the D/A where a new control value is simply 
written into a register. This limits the speed of the 
control response. 

In this mode the stepper motor is used as an open loop 
device and the pulse rate must be limited so that the motor 
has sufficient time to respond. To guarantee zero 
steady-state error in case pulses are missed some integral 
control must be used3. Pulses can be missed by the notor in 
case the load on the motor shaft exceeds the specified 
Maximum torgue, or when the pulse rate exceeds the maximun 


recommended value. 


This stepper motor controller measures the input 
voltage and translates it to a frequency according to figure 
7. There is a dead zone in the controller with a width of 
approximately 1 step. This is necessary in order to prevent 
the motor from hunting around the set-point. The polarity of 


3 Janos Gertler, "Position vs Velocity Algorithms in 
d.de-c.", Instrument Practice, Dec. 1968, p.- 1015 
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the input voltage also determines the direction control. 
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Fig. 7 Error vs Frequency for Stepper Control 


3-4.2 Velocity Stepper Motor Control 


In this control mode the previous PID output is 
subtracted from the present one to generate the velocity or 


rate control. This control value is then multiplied by an 
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overall gain constant for the stepper motor system in use 
and the resulting number is output as a series of pulses to 
the motor. The maximum number of pulses is limited to 255. 
The pulse rate is user selected and can be any even integer 


from 6 ms to 256 ms. 
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4. Controller Design 


This chapter deals with the design of various types of 


controllers. 


4.1 PID design 

The design of PID controllers is a subject well covered 
in numerous publications. See, for example, Ogata*. As long 
as the sampling period is short compared to the tine 
constants of the plant, the controller coefficients can be 
designed using standard methods found in the texts. A 
controller can also be found experimentally by simply 
varying the coefficients until satisfactory control is 
reached. | 

Since the exact plant transfer function is often not 
known in industrial processes, approximation techniques are 
commonly used for controller design. The Ziegler-Nichols 
methodS is well known and uses two easily performed 
measurements to determine the controller coefficients. The 
necessary measurements are the time lag and response rate of 
the system. They are measured by applying a step to the 
open-loop plant and measuring the output response. Some 


fine-tuning of the controller is also often required. 


4 Katsuhiko Ogata, "Modern Control Engineering", Prentice 
Hall, New Jersey, 1970 

5S Ziegler, J.G. and Nichols, N.B., "Optimum Settings for 
Automatic Controllers", ASME Transactions, 64, 1942, p.759 
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In general, 

1) The proportional gain is increased to speed up 
response and lower offset error. There is a 
limit beyond which the system will be unstable. 

2) Integral control is added to reduce the 
steady-state error if the plant does not contain 
a free integrator. Integral control introduces 
phase shift which can cause instability. 

3) Derivative control can be used to increase the 
stability of a system with a lagging phase 
margin. i.e. too many integrators. Derivative 
control increases the noise sensitivity of the 
systen. 

The important difference, in using the digital PID 
controller, is when the sampling time becomes comparable to 
the plant time constants. A system stable for fast sampling 
times will exhibit an increasing overshoot as the sampling 
time iS increased. At some point the system will become 
unstable. This problem is related to the phase shift 
introduced when a signal is reconstructed by a zero-order 
hold device. Excessive phase shift will cause instability 


due to the loss of sufficient phase margin. 


A dead-beat controller is one in which the output 
variable reaches the set-point in the shortest time 


possible, and the derivatives of the output reach zero at 
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the same time. If the control output is not constrained in 
Magnitude it can be shown that the output will reach the 
set-point in a minimum of N sampling periods. N is the order 
of the system. If the control is constrained, more than N 
samples will be required. The magnitude of the control 
outputs are related to the sampling time, so that the 
control magnitudes can be reduced by increasing the sampling 
period. 

Dead-beat response can be accomplished by designing the 
transfer functicn to cancel ail poles and zeros of the 
combined system response with the exception of the single 
pole at z=1. However, this method allows intersample ripple 
in the output of the plant. This can be eliminated if the 
controller is designed such that all derivatives are equal 
to zero and the output is equal to the set-point after the 
reguired number of samples. This is the case in which we are 
primarily interested. 

If the plant contains a free integrator, the output of 
the controller is zero at the end of the N samples. If, 
however, the plant does not contain a free integrator, then 
the D(z) controller must maintain an output. i.e. the 


digital transfer function must contain the integrator. 


- 2.1 Dead-Beat Controller Pulse Transfer Function 


It is convenient to use the state variable 


representation. The system transfer function is given hy, 
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andthe Output Ws, 


This is shown in the block diagram of figure 8. 
It is possible to design the dead-beat controller in 


general®, The resulting D(z) function is given by, 
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~k ar ie E 
p¢z) = LY 2 PCk)HP(N) APD YE 28 - Y cea*' ppc) 7! 
k=0 |=2 k=0 2=0 
Cie eat q ° rue | ae ot eae 7 
| i @ KE el Fila x | | 
U--->] GG Jn-->t---->f$  -  f----- >| C f[---> y 
i i | PSE Wal | | 
L—-—-—-——J | t----=— 4 | t_—---—-—-— J 
| | 
{ Cea ae. 7 { 
{ i l | 
i-<--{ F |<--4 
| { 
l—----=+ J 
Figs State Variable Transfer Function 


6 J. Ae Cadzow and He. R. Martens,"Discrete-Time and Computer 
Control) Systems! 211970" , pp. 1259-263 


“Te 


me iv >) | : a. as. 
er - as ; = a Phy ee 

— ww ee 7 eee 
ie ms Bi» 7 | % 


s4 to tlettnew tm 
ve ter ¥ 


=~ = & & 


go xe cerwt meme nhesree , 1% ES) 


je¢nreepubst, e461 


ES, 


Where P is found fron, 


| ae | 

(meo (0) 20 
zea N mace 2.00) 0 Ml gees 
[eChest BOMCAU—238l i. CB OT, =< Pe beeen 
{ i {=4 0 eam 
(FANS 5 SPAN-23 22. FBG {{. . (epee Orne 
L— —4 | - { t— -J 

(reo (N= 1) 

(rep s(N eet 

Lo - 


— oe ee oe oe ———— —————— —<_ = ———— ——— SS awe ae SS ee ee eee es a ee ee we 


The above given algorithm for the design of the minimal 
time response ccntroiler can easily be programmed on a large 
digital computer. Since the solutions are in matrix form, a 
particularly convenient language to use is APL. APL has aii 
of the matrix manipulation operators as primitives. 

A program was developed in APL to calculate the 
dead-beat coefficients for second and third order systems. 
The program is general and the systems are not restricted in 
requiring the presence of a free integrator. Note however, 
that the program is restricted to systems having one input 
and one output, as is the controller system under 
discussion. The discrete state matrix is given by, 

x (k+1) = A x(k) + B u (k) 


and, 


The program requires the F matrix, the G matrix, the 
output matrix C, and the sampling period T. The results are 
the A matrix, the B matrix, and the D(z) -coefficients. The 


coefficients are output in the same form as the normalized 
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D(z) form described earlier. 
The program is run by the following sequence. 
1. Signon to MTS 
2. $$RUN *APL 
3.  )LOAD DEAD 
4. DEAD 
5. The program then prompts for the needed matrices, which 
are entered by rows, with each row going from left to 
right 
€é. When the calculations are completed the program prints 
the results 
The algorithm used is the series evaluation of the 
state transition matrix given in Cadzow and Martens’. The 
program uses 100 terms of the series which results in at 


least 8 digits of accuracy. 


In general, the basic design procedure for the 
dual-mode type controller is as follows. 

1) Design the PID controller using standard design 
technigues, using sampling time TO 

2) Design the dead-beat response considering the 
restraints of control magnitude and the desired 
step response time, using sampling time T1 

3) Enter the coefficients into the controller and 
test the system, noting that either the D(z) or 
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There are many advantages to implementing filters with 
digital techniques. Some of these are; 
1) Repeatable performance from unit to unit 
2) Precision limited only by arithmetic 
capabilities and D/A, A/D resolution limits 
3) Digital domain has no impedance matching 
difficulties 
4) Critical break frequencies can be placed with no 
tuning or adjustments reguired 
5) No dependence on component value variation due 
to temperature or age 
6) Filter characteristics are easily modified by 
Changing digital words in memory 
Since there is a wealth of information on analog filter 
design, it can be advantageous to design the filter using 
analog methods, and then transform the filter to the digital 
form. For analog filter design see ‘Simplified Modern Filter 
Design'. 8 
One method known as the impulse invariant transforre 9? 
uses the following steps. 


1) Design the filter with analog techniques 


® Geffe, P.R., "Simplified Modern Filter Design", John F. 
Rider, New York, 1963 

° Childers and Durling,"Digital Filtering and Signal 
Processing", 1975 
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2) Take the z-transform of the s-domain impulse 
transfer function 
3) Implement the filter using the controllers D(z) 
operational mode 
AS a Simple illustration of this method take the 


transfer function, 


This corresponds to the low-pass filter with the breakpoint 
at 5 Hz. Taking the z-transform of the above with a sample 


time of 10 ms yields, 


=O. SGe7Ze4 


This filter was implemented and tested on the systen. 

Note the relationships between the transfer functions 
of the digital and analog filters. In the s-domain s-! 
represents analog storage, an integrator. In the z-domain 
the z-1 operator represents time storage, or delay. 

The z-transform technigue of digital filter design is 
covered in humerous texts. An excelient reference source is 
"Digital Filtering'. 19 

The frequency range that can be covered with the 


controller described in this thesis is limited by the 
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sampling rate, which in turn is limited by the CPU 
calculating time. By Shannon's sampling law the input signal 
hust be sampled twice every period. Since the fastest 
sampling rate is 10 ms, the upper frequency limit will be 50 


HZ. 
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5. Controller Tests 


This chapter describes various tests performed with the 
controller. Pictures are included showing the response of 
the system and the controller. 

The following photographs illustrating the controller 
have the top trace showing the plant output and the botton 
trace showing the controller output. Unless stated otherwise 
the photographs have, 

1) Sweep time 2 S/div 

2) Top trace 2 V/div 

3) Bottom trace 5 V/div 
For most systems a 4 volt step was applied from the 
keyboard. 

Figure 9 lists the plant transfer functions that were 
used for the controller tests. Also listed is the dead-beat 
controller, for which the coefficients were calculated by 


running the APL program described earlier. 
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Fig. 9 Plant Transfer Functions 


-1 PID Mode Tests 


The proportional part of the PID controller was tested 


with a known input and gain constant Kp. The inputs and Kp 


were changed and the output checked for the proper value. 


To test the integral part a step was applied to the 


system with only the integral gain constant non-zero. The 


results of this test for two different sampling periods are 


shown in figures 10 and 11. 


The derivative part was tested similarly as seen in 
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figures 12 and 13. 

The results of the above confirm the operation of the 
FID control elements. 

A simple PI controller was tested by implementing the 
control function Kp=1, Ki=0.1, and T=0.1 seconds using 
system A. The response of this system seen in figure 14 can 
be compared to the response of the dead beat controller for 
the same system, figure 19. — 

System B was controlled with Kp=1 and sampling times 
varied from 0.1 tc 4 seconds to illustrate an analog stable 
system becoming unstable as the sampling time is increased. 
This is seen in figures 15 to 18. The instability is clearly 
seen for the sample time of 4 seconds. 

The applied step was 4 volts except in the last case 
where it was 5 volts. These four illustrations use a time 
base of 5 s/fdiv. Note the scale change of the last case , 5 
V/div and 10 V/div for the top and bottom trace 


respectively. 


2-2 D(z) Mode Tests 
Dead-beat controllers were designed for systems A, C, 
and D of figure 9. Figure 20 shows the control of a plant 
with a free integrator. Plants without free integrators are 
shown in figures 19 and 21. A 5 volt step was appled to 


system A and 4 volt steps to the others. Dead-beat response 


was achieved in all cases. 
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523 Dual-Mode Tests 

System B was used for the dual-mode control operation. 
For all cases the step is 4 volts. The proportional 
controller has Kp=1 and T=0.1 s. The dead-beat controller 
uses T=1 s. fhe dual-mode in normal operation is seen in 


figure 23. 


-321 Test with Plant Pole Variation 


It is interesting to compare the table look-up method 
with the D(z) dead-beat method when the plant parameters are 
varied. First the pole at s = -1 is moved to -1.25, seen in 
figures 24 and 25. Next the pole is moved to -0.75, seen in 
figures 26 and 27. 

It is seen that the D(z) control is more accurate than 
the table method when the plant changes. This is expected 
Since the table method is essentially open loop control for 
the dead-beat period. The D(z) is closed loop and will tend 


to compensate for the parameter change. 


A similar test was performed with the two dual-mode 
controller types in the presence of noise. The noise was 
injected into the ioop from a SERVOMEX noise generator. The 
noise bandwidth is from 0.05 to 50 Hz with an RMS value of 
0.25 volts. 

As can be seen in figures 29 and 28 the table method is 


more accurate than the D(z). This is also to be expected due 
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to the nature of the D(z) transfer function. The output 
values are calculated from instantaneous input samples and 
any noise in the loop will effect this measurement, causing 
an incorrect output. The table method does not measure the 
input and is therefore not affected by the presence of 
noise. 

The dual-mode controller was also tested with a plant 
without a free integrator. This confirms the transition 
between PI and dead-beat. The PI control was T=0.1, Kp=1, 


and Ki=0.1. The result can be seen in figure 22. 


2:4 Stepper Motor Control Tests 


The stepper motor was connected to a potentiometer 
through a 5 to 1 gear reduction. The potentiometer was 


connected to +12 volts. 


5.4.1 Positional Stepper Motor Test 


The wiper voltage was used for the feedback signal, and 
was connected to the controller input. Figure 30 shows the 
response of this system to a 5 volt step. The top trace is 2 
V/div and the bottom trace is 5 V/div. The sweep rate is 100 


ms/div. 


First the output of the three control elements was 
tested, as shown in figures 31, 32, and 33. All of these 
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1) 
2) 
3) 
4) 
5) 


6) 


Top trace = 5 V/div 
Bottom trace = 2 V/div 


Sample time = 2 Sec 


Pulse time = 10 msec 
Sweep rate = 2 Sec/div 


Velocity overall gain = 0.095 


The controller gains are; 


1) 
2) 
3) 


The individual 


correct. 


Kp = 0.5 
Ki = 0.1 
Kd = 1.0 


response of the PID elements is seen to be 
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To further test the stepper motor control system, a PID 


controlier for system E was implemented. System E was tine 
scaled by a factor of 10 to reduce the effect of the slow 


motor response. 


1) 
2) 
3) 
4) 
>) 
6) 
7) 
8) 


9) 


Vertical 2 volts and 5 volts /div 


Horizontal 15 sec/div 
Overall gain = 0.06 
Sample time = 2 sec 

Step pulse time = 10 msec 


Applied step = 4 volts 


Kp = 2.00 
Ki = 0.150 
Ka = 1.50 


fhe following data holds for figure 34. 
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Dual-Mode with pole at -1.25 
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Table Dual-Mode Control of B with Noise 


D(z) Dual-Mode Control of B with Noise 
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Fig. 
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Stepper Motor Positional Response 


Velocity Algorithm, Proportional Output 
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Velocity Algorithm, Derivative Output 


ea | 


58 


Velocity Algorithm, PI Control 
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Conclusions 
User experience has shown that this micro-processor 
controlier system is useful and convenient to use ir the 
laboratory. Combined with the plant G(s) Simulated on an 
analog computer it provides a simple means to study the 
z-transform D(z) and the digital PID control algorithn. it 
also allows the combined dead-beat and PID to be studied. 
The coefficients are easily changed from the keyboard and 


the effects can be seen immediately. 
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Future Plans 
During the next year the device will be used in the 
undergraduate controls laboratory. Student experience will 
then provide evaluation of the device in actual student 
laboratory practice practice, and perhaps suggest further 
improvements. 
The device will also be used as a digital filter for 
Signal conditioning of certain biological signals. 
There are many other extensions possible to this 
machine. Several under consideration are given below. 
1) Word size truncation to show the effect of fewer 
bits on the control accuracy 
2) A proportional-integral bang-bang controller 1! 


3) Selectable time delay before output of control 


ee OO SO OO Oe @ OS @ @ = = 


11 L.M. Zoss, Ke Mortimer, and K.H. Vetter,"Novel Bang-Bang 
Algorithm for Direct Digital Control", instrumentation 
Technology, April 1970 
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Appendix 
The appendix contains system flowcharts, the memory map, 
schematic diagrams, the program source, and the operators 


Manual. 
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Operators Manual 

This laboratory device is a microprocessor based 
digital controller. 

The unit has two major types of feedback control, the 
standard PID algorithm and the D(z) control, which can be 
used for deadbeat controllers or digital fiiters. The 
control mode, sampling time, and the various coefficients 
are all conveniently entered from the keyboard. A diagram of 
the keyboard is ¢ghown in figure 35. 

The digital controller features sampling times from 10 
ms to 30 s. The A/D and D/A converters are capable of analog 


voltages ia the range of +10 volts with a resolution of 12 


bits. 
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Number Buttons 

The right half of the keyboard has the numerical keys, 
the minus sign, and the clear command. The clear button is 
used to clear the display, while the numbered keys and the 
minus Sign are used in entering numbers inte the display. 
Numbers from the display are entered into memory hy pressing 
the load set-point, load sampling period, or load 
coefficient keys, after the digital display shows the 
desired number. To enter a coefficient the number keys are 
pressed until the display shows the desired number in 
normalized scientific notation, (fractional mantissa 
followed by exponent), after which one of tke load function 
keys is pressed, followed in some cases by another pnumber, 
the subscript value. i.e. (LDC,n) where n is the subscript 
and refers to the specific coefficient being stored. Both 
the sampling periods, set-point, and coefficients have 
limited ranges, and attempting to load numbers outside of 
these ranges will generate error messages, and the number 
will not be stored. The display automatically adds the 
decimal point at the first position when the first digit is 
pressed. Entering singie numbers for D(z) order or control 
mode is done by pressing the function key followed by the 
Single digit number. 

The left half of the keyboard contains all cf the 
function buttons. Their operation is described ir the 


following section. 
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ie 
i 


This is the button to reset the microprocessor. it will 
clear ail memory locations. This button should only be used 


if the processor has gotten lost in its progran. 


@) 


Cll 
This key clears the integrator used by the PID control 
mode. This is the same as loading the integrator with an 
initial value of zero. 
LDZ 
This function is used to change the order cf the D(z) 
controller. LDZ is pressed followed by the desired order for 


the D(z) transfer function. The controller will accept 


orders from 1 to 3. 


IS 
IN 


Pressing DDZ will cause the D(z) order to be displayed. 


t 
& 


This button is used to select the control mode. LCM is 
pressed followed by a control mode from 0 to 7. The 
following control modes are irplemented: 
0-PID 

This is the standard PID controller. This node 
implements the discrete PID algorithm and uses coefficients 
Kp, Ki, and Kd.(See LDC for loading) The three parts of the 
control are implemented according to the equations given in 
the thesis body. The PID controller uses sample time TO. E1 


is the sampled input (i.e. the plant output) and E2 is the 
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controller output. Note that entering a set-point change 
causes the derivative control element to be disabled for 
four sampling periods. 

1-D (z) 

This is a D(z) controller which is intended to be used 
in the same configuration as the PID controller. The control 
algorithm implemented is discussed in the thesis body under 
D(z) Implementation... 

E2 is the output signal and E1 is the sampled error 
Signal. The coefficients used by this control mode are AO, 
Al, A2, A3, B1, B2, and B3. signal. The sampling time used 
is TO. The maximum order (N) is 3. fhis control mode is used 
to implement various digital controllers, of which a 
dead-beat or minimal time response is one possibility. (see 
LST button) 
2-Dual Mode D(z) 

This control mode uses the PID mode as long as no 
set-point changes are initiated. If a set-point change is 
entered the controller switches over to the D(z) mode for N 
samples, where N is the order of the D(z) controller. The 
D(z) function should be set up for dead-beat response. The 
PID controller in this case uses sampling time TO while the 
D(z) uses sampling time 11. The use of separate sample times 
allows for flexibility. The advantage of this mode is to 
have the noise immunity of the PID controller combined with 
the ability of the dead-beat response to perform state 


changes of a plant in minimal time. 
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3-Dual Mode with Table Look-up 

This mode is the same as mode 2 with the exception that 
instead of Switching over to the D(z) mode for set-point 
changes, the controller will output to E2 values that are 
held in memory. The control table values have been 
previously calculated for the known plant transfer function 
G(s) and are stored in coefficient locations AO, Al, A2, and 
A3. If the D(z) order is 1 AO followed by Al will be output, 
multiplied by the error, before the controller switches back 
to the PID mode. If the order is 3 all of the values from AO 
to A3 will be output sequentially with the time between each 
given by sampling time T1. 
4-Stepper Motor Velocity Algorithm Control 

This mode has pulse and direction outputs intended for 
stepper motor control. At each sampling instant the A/D is 
read and the error signal generated by subtracting from the 
set-point. Next the PID controller is called to calculate 
the control signal. The control signal is then multiplied by 
a gain constant SG (in location B3) to give an integer 
result. This integer is truncated to 8 bits and stcred in a 
counter. The counter then outputs the count at a pulse rate 
which is stored in location T2, (LSI,2). The gain constant 
is related to the number of steps per volt for the 
motor/system under control. 

Used in this manner the stepper motor can be viewed as 
a digital to eaacekectne: tens It has the advantage of 


holding its output in case of a power failure. 


a 


i 
7 


a an 
teat Feat ; 
¢atog-19% 103- bon | 

wis tod¢ Gonlav os oe | 
Seed sod soukae 2 

noreoart setuapid sake sae 58 get 
bre .SA 06 Oe BnOhi e205 jaoRsthReao cs tniase i bt 
-gugsoo od L52y ta Yd Sovekiow oe tet qwba0' (a}@ std 5 
ipsi Gedos ivy tebiestres sif7 otek ,308Te ott “a soigiseoe 
G4 sowd eevlas ond tO Tig @ ee 1sh10 od 32 sobow a2 eat 
ions ussedod dgt* odd dhiw qiisttnep pen: sugtuo ot TM EMO 
. Viana paiggnos ye wale” <a 

wag sed widtaoeth qsisoken aozoi 2aqqase—H a 

oe} uaa 0 etug¢no doitpeuif. hae eaiopeaas shas aad " ; ” 


: 

ad? su 72 pee foered ives’ Ya sats 2anep ieapia 20376 uy bam tipo ah 
soley of beileo ab tetfetdnon GE ob? axel sae togeree : 

'§ otiiealtlvg aed? Of Leapie Iosta6o of? ..feagre fosdiaosedd : 
systul A avip oF 400 aotteped wi) 8 saatenwe ahaa 

o ai tegota bas 23id @ of. Sedseness SE aspesae alt? .*iveex 
o1sa aafvq s 20 Javon Sti uetdqewo Gade Tedreot MP Sree 
acteaco aisb, edt » (8 28I), S? uobt¢apal ab ferota al dokdy 

add 10% Jinw aay. aqeae to jodie oft of. baton ae 

-i44ta09 sahao neacya\ysor pe te 

an bewSiv od cep sede soaaeise, ode sodane ide > 7 

lo svetisrie oad. eb, Bis “tobzeraen yoLuns o 


uma rawag 5 Sahn oh pent 


Ge eof} 2oe¢e¢ek pailqase dose 22. «Lozaaee so30a, _ soa = 


y 


i 


ea 


68 


When the system is set up the stepper motor should be 
Mahually positioned at its zero control position and CLi 
pressed to clear the integrator before power up of the 
motor. Integral control should always be used due to the 
possibility of the motor missing pulses under high load and 
fast puise conditions. 

Note also that sampling periods are limited by the 
response time of the motor. At a step pulse rate of 10 aos, 
255 pulses (the maximum) will take 2.55 Seconds. 
5-Stepper Motor Positional Control 

This mode uses the pulse and direction outputs the same 
as mode 4. The PID elements are also used but often only Kp 
would be non-zero. This control mode uses the error signal 
to generate a pulse rate to the motor. A larger error causes 
a higher frequency. The frequency varies from 1 Hz to 200 
Hzs A ene ene is found in the thesis body. 

This control mode is a common method used in x-y 


plotters etc. 


[CC 


This key is used to display the selected control mode 


on the digital display. 


LSP The set-point is loaded using this function button. When 
the display contains the desired value for the set-point the 
button is pressed and the set-point will be loaded. This 


function also initiates certain other control actions in 
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control mode 0, 2, and 3. In mode 0 the derivative control 
is disabled for 4 samples. This is the bumpless transfer 
feature and eliminates large control values, due to the 
derivative term, when the set-point is changed. In modes 2 
and 3 a set-point change initiates the switch over to 
dead-beat control for N + 1 sample periods (N is the D(z) 
Order). 

Since the D/A converter range is +10 volts, set-points 
cannot be loaded outside of these limits. The D/A converter 
has 12 bits of resclution resulting in the minimum step size 
of 4.88 mV. Attempting to load a set-point of magnitude less 
than 3.4 mV (with the exception of 0) will result in an 
€rror message on the display. Loading a set-point of 0 is of 


course permitted. 


IF 
iro 


This function button causes the current set-point to be 


shown on the digital display. 


Io 
IH 


When the display shows the desired sample time in 
seconds, (aS usual in normalized scientific notation), this 
function button is pressed followed by 0, 1, or 2 to load 
sampling time TO, T1, or T2 respectively. TO is used by all 
control modes and 11 is additionally used by modes 2 and 3. 

The range of sampling periods allowed is 10 ms to 30 s, 


and values outside of this range will not be stored. 
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T2 is the pulse rate used to control the stepper motor 
in mode 4 The minimum value is 6 ms, and even periods can 
ke loaded up to 254 ms. Odd numbers may be loaded but they 
will be rounded to even since the resolution of the hardware 


is 2 Ss 


Dsi 
DST is used to display the set sampling times. To use 
it the key is pressed followed by 0 or 1 to display TO or T1 


respectively. 


LDC 
This function is used to load the various coefficients 
used by the controller. Similarly to LST the display must 
first contain the desired number, when it does ,LDC is 
pressed followed by a digit from 0 to 9. 
The first three are used by the PID controller. 
0 - Kp the proportional gain 
1- Ki/T the integral gain divided by the 
sampling period 
2 > Kd*f the derivative gain times the 
sampling period 
The last seven are used by the D(z) controller. 
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A= BBA 
SEB Z 
94 =) BS20R2SG 
SG is the overall gain for mode 4. 
The range of coefficient magnitude which the controller 
will accept is 0.001E-3 to 0.999E+3. Numbers outside this 
range will generate an error message and the original 


coefficient will remain in storage. 


DSC 
This function button displays the coefficients stored 
in the controllers memory. Similarly to LDC it is pressed 


followed by a digit from 0 to 9. 


Pressing keys in improper order, attempting to load 
numbers that are out of range, or using subscripts that are 
out of range will cause an error message to be displayed on 
the digital display. 

The following error messages are defined. 

Error 0 Subscript number is out of range. 
e.g. (LST,3) would cause this error 

Error 1 Coefficient magnitude is out of range. 
e.g. display=.145E4 (LDC,2) gives 
this error 

Error 2 Sample time is out of range. 


e.g. display=.100E-2 (LST,0) causes 
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this error to be displayed 

Set-point number is out of range. 
e.g. display=.100E3 (LSP) gives 

this error message 

D(z) order or control mode number 

out of range. 

e.g~- (LCM,8) would give this error 
Another function was called before 
finishing the first one. 

€.g. (LDZ,LSP) would cause this error 


Since LDZ is expecting an integer. 
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Short Form Operators Manual 


Reset the microprocessor, clears the memory 
Clear the PID integrator 

en Set D(z) order to n 
Display D(z) order 


en Select control node n 
Control modes are, 
PID 
D(z) 


Dual-mode with D(z) for step 
Dual-mode with table for step 
Stepper Motor Velocity Algorithm 
Stepper Motor Positional 
Display the selected control node 
Load the set-point 
Display the set-point 
7) Load sample time n 
All modes use time 0 and 
dual-mode controllers use 
time 1 for set-point changes 
Time 2 is the step motor 
pulse rate (mode 4 only) 
7 Display sample time n 


ne WHO =O 


7n Load coefficient n, n=0 to 9 
The coefficients are, 
Ga akp 5 A2 
Wh KiZt 6 AS 
2 Kd*T 7 Bi 
3a, A0 8 B2 
G AT 9 B3 or SG 


SG is the stepper control gain (mode 4 only) 
en Display coefficient n 


The error messages are, 


Error O Subscript number is out of range. 
Error 1 Coefficient magnitude is out of range 
Error 2 Sample time is out of range 
Error 3 Set-point value is out of range 
Error 4 D(z) order or control mode number 

out of range 
Error 5 Another function was called before 


finishing the first one 
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System Memory Map 
COUN Coe weeietOe 9) On a Ol Bete 8. 2s th G 


ee cir een ere oc Oe Bee ee ge 1 oo : 
FAM 10 00x x x : 
KEYBOARD trac = a ae re 
umn = [p01 00 00 0 00 8 0 
Cee re re ce 


STATUS DaA f7:0. 1 OL. wlan Xena’ xX" x xs x x 0. 1 { 


A/D PIA ec aN 0 6) te aXe Xe EX Fe xk Sx, 1 0 | 
ROM 0 oe ae ia RA i rn | 
FOM 1 cy EEL) CAIRO RIC SD ak Gand Laas" 5 i aa 
ROM 2 ay IL Wy SEI Ee |S iia ees 
ROM 3 te opt IS ie de anaes IN Cacia it aaa 

bw ee we we we ee oe ee oe ew ew we a ee we ee ww ow we ow es os wwe = a 


1. x is a don't care bit and is nct decoded. 

2. A blank address bit is used by the device at that 
address. 

3. ROM O is not used and is a spare for future expansion. 

4. ROM 1 contains the control algorithms. 

5. ROM 2 contains the multiply routine, the restart 
routine, and other utility programs. 

6. ROM 3 contains the keyboard, timer, and display control 
routines. 

7. STATUS PIA is used to control the overload indicators. 

8. KEYBOARD also controls the digital display. 

9. RAM addresses 0000 to 00D5 (Hex) are used by the control 
progran. 


10. RAM addresses O03A0 to O3FF (Hex) are used by the stack. 
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The Program Source Code 


NAM ROM 

ORG $0000 
DCTR RMB 1 ;DIGIT DISPLAY POSITION COUNTER 

KP RMB 3 ;PROPORTIONAL GAIN CONSTANT 

LSMPL RMB 2 ;PREVIOUS SAMPLE VALUE 

SMPL RMB 2 ;PRESENT SAMPLE VALUE STORAGE 

TKP RMB 3 ;TEMPORARY STORAGE FOR KP 

SPFN RMB 2 ;FUNCTION IN USE FLAG 

KI RMB 3 ;INTEGRAL GAIN CONSTANT 

KD RMB 3 ;DERIVATIVE GAIN CONSTANT 

XTEMP RMB 2 ;TEMPORARY STORAGE FOR X 

CNITL RMB 2 ;CONTROL VALUE STORAGE 
ISMPL RMB 2 ;INTEGRAL CONTROL 

DSMPL RMB 2 ;DERIVATIVE CONTROL 

TMP RMB 3 ;TEMPORARY STORAGE FOR COEFFICIENTS 
%* 
KPT RMB 6 ;STORAGE OF BCD VALUES 
KIT KRME 6 ; USED FOR THE DISPLAY SO THAT HEX 
KDT RMB 6 ; NEED NOT BE TRANSLATED TO DECIMAL 
* 

KIND RMB 6 ;INPUT TO DECIMAL TO HEX 

KINI RMB 9 3;STORAGE LOCATIONS USED BY 

KINB RME 4 3; THE ROUTINE TO TRANSLATE 
KINBT RMB 4 3; DECIMAL INTO HEX 
KINHF RMB 3 3;THIS HAS THE RESULT IN IT 

a . 
SMPT RMB 6 ;SAMPLE TIME DISPLAY STORAGE 

SMPTT RMB 6 ;TEMPORAY STORAGE FOR DISPLAY OF TIME 
DS RME 8 
CNIMD RMB 1 3;CONTROL MODE 


AO RMB 3 ;COEFFS FOR D(Z) 
Al RME 
A2 RMB 
A3 RMB 
E1 RMB 
B2 RMB 
B3 RMB 
AOT RMB 6 
A1T RMB 6 
A2T RMB 6 
A3T RMB 6 
6 
6 
6 


i) Ws W Od WW W 


;DISPLAY DIGITS STORAGE 


E1T RMB 

B2T RMB 

B3T RMB 

G RMB 2 ;CALCULATION OF G 

H RMB 2 ;CALCULATION OF H 

XO RMB 2 ;DELAYED X'S FOR D(Z) 
X1 RMB 2 

X2 RMB 2 

X3 RMB 2 

DZN RMB 1 ;ORDER OF D(2Z) 
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DZNT RMB 1 ;FOR TEMP USE OF D(2Z) 

* 

DCML RMB 1 ;USED TO SET DECIMAL 

SETPNT RMB 2 ;THIS IS THE SETPOINT 

BMPFLG RMB 1 ;BUMPLESS TRANSFER FLAG 

SETPD RMB 6 ;DISPLAY OF SET POINT 

DCSP RMB 2 ;DECIMAL SET POINT 

TSRC RMB 2 ;SOURCE SAVE FOR MOVE 

IDST RMB 2 ;DESTINATION FOR MOVE 

PPX RMB 3 ;USED BY PUSH AND PULL Xx 

DSPLY RMB 6 ;TEMP SAVE FOR DISPLAY 

DZPFLG RMB 2 ;DUAL MODE CONTROLLER FLAG 
IMSV RMB 4 ;TIMER VALUES 

STEPS RMB 1 ;STEPPER MOTCR COUNTER 

LCNTL RMB 2 ;LAST CONTROL OUTPUT 

ISTP RMB 2 ;STEP PULSE TIME STORAGE 

STTMD RMB 6 ;PULSE TIME DISPLAY 

MOVE EQU $C800 ;MOVE ROUTINE ENTRY POINT 
CNTLP EQU $C400 ;CONTROL ENTRY POINT 

WDAI EQU $90 ;WRITE DISPLAY AUTOINC 

WD EQU $80 ;WRITE DISPLAY 

RB EQU $40 ;READ BUTTON 

RDAI EQU $70 ;READ DISPLAY 

CD EQU $DO0 ;CLEAR DISPLAY 

KDSP EQU $2000 ;BUTTON AND DISPLAY ADDRESS 
FMLT EQU $C80C ;MULTIPLY PROGRAM ENTRY POINT 
DA EQU $5800 ;D/A PIA ADDRESS 

AD EQU $5808 ;A/D PIA ADDRESS 

TIMER EQU $2008 ;TIMER ADDRESS 

CVLD EQU $5804 ;OVERLOAD PIA ADDRESS 

TCR3 EQU $82 ;TIMER 3 CONTROL REGISTER 
ICR2 EQU $81 ;TIMER 2 CONTROL REGISTER 
TSTC EQU $24 ;CONTROL FOR STEPPER TIMER 
TCR1 EQU $10 ;TIMER 1 CONTROL REGISTER 
TOEN EQU $80 ;TIMER 1 OUTPUT ENABLE 

TICR EQU $40 ;INTERRUPT CONTROL FOR TIMERS 
STRT EQU $C809 ;START-UP ROUTINE 

GHDIN EQU $C803 ;DIGITS INPUT TO COEFFICIENTS 
* 


* THIS IS THE LOWEST ADDRESS ROM 
ORG $C400 

x 
* THIS ROUTINE WiLL PERFORM 

* THE DIFFERENT CONTROL 

* OPERATIONS 
CNTLP LDA A TIMER+1 ;GET STATUS 
BIT A #$02 31S IT SAMPLE TIME? 
BNE CNW 

Bit. A #301 SISCIT STEPPER? 

BEQ CNTX ;NO 

TSTUSTEES 

BEQ CNT1 ; ALREADY ZERO 

DEC STEPS ;OTHERWISE DECREMENT IT 
LDX TSTP ;PULSE OUT TO MOTOR 
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Six, TRSERtZ 

BRA CNT2 
CNT1 LDA A #TSTC ;TURN OFF INTERRUPTS AND OUTPUT 
STA A TIMER 

CNT2 LDA A TIMER+1 

LDX TIMER+2 ;CLEAR INTERRUPT 
BRA CNTX ;EXIT 

CNW CLR ADt2 ;START SAMPLE 

* FIND CONTROL MCDE 

* AND JUMP TO IT AFTER GETTING SAMPLE 
LDX #CNTBL 

LDA B CNTMD 

JSR ULDE 
CNW1 TST AD+3 ;WAIT FOR SAMPLE 
BPL CNW1 

LDA A AD+2 ;GET MSB 

LDA B AD ;GET LSB 

COM B ;COMPLEMENT IT 

AND A #$0F 

BIT A #$08 ;TEST FOR NEGATIVE 
BEQ SPS 

ORA A #$FO 
SESPUSTALAASMPL 

STA B SMPL+t+1 
* CALCULATE SET POINT 
* MINUS THE SAMPLE 

LDA A SETPNT ;GET SET POINT 


LDA B SETPNI+1 

SUB B SMPL+1 ;SUBTRACT SAMPLE 
SBC A SMPL 

STA A SMPL ;SAVE IN SAMPLE 
STA B SMPL+1 

x 

* NOW JUMP TO CONTROL MODE 

JSR 0,X 

LDX SMPL 


STX LSMPL ;SAVE LAST SAMPLE 

LDX CNTL ;SAVE LAST CONTROL 

STX. LCNIL 

LDA A TIMER+1 

LDX TIMER+4 s;CLEAR TIMER 2 INTERRUPT 
LDA A TIMER+1 ;CLEAR TIMER 1 INTERRUPT 
LDX TIMER+2 

CNTX RTI 

* THIS IS THE PID CONTROLLER 

PIDC BSR PIDCC 

JSR SMOUT 

JSR PIDCD 

RTS 

ok 

PIDCC JSR FMLT ;MULTIPLY BY 

FDB SMPL ;KP 

FDB KP 

STA A CNTL 
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TST 
BNE 
CLR 
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BRA 
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B CNTL+1 
Kit 

£C 
ISUPL 
ISMPL+1 
DC 


IC JSR FMLT ;CALCULATE INTEGRAL 


FDB 
FDB 
LDX 
JSR 
LDX 
JSR 


SMPL 

KI 

#ISMPL 

DADD 

#CNTL ;ADD TO OUTPUT 
DADD 


* SKIP DERIVATIVE WHILE BUMFLESS IS SET 
CC TST BMPFLG 


BEQ 
DEC 
CLR 
CLR 
RTS 


DCA 
BMPFLG 
DS 
DS+1 


DCA LDA A SMPL ;CALCULATE DERIVATIVE 


LDA 
SUB 
SBC 
STA 
STA 


B SMPL+1 
B LSMPL+1 
A LSMPL 

A DS 

B DS+1 


* TAKE AVERAGE OF LAST 4 SLOPES 
* A,B HAS PRESENT SLOPE 


ADD 
ADC 
ADD 
ADC 
ADD 
ADC 
ASR 
ROR 
ASK 
ROR 
STA 
STA 
JSR 
FDB 
FDB 
LDX 
JSR 
RTS 


DS+3 
DS+2 
DSt5 
DS+4 
DSt+7 
DS+6 
;DIVIDE BY FOUR 


DSMPL 
DSMPL+1 
FULT 


Droarwrrpw ry wr wo 


* NOW MOVE DELAYED DERIVATIVES 
PIDCD LDX DS+t4 


sTX 
LDX 
STX 
LDX 
STX 
RTS 


DS+6 
DS+2 
DS+4 
DS 

DS+2 


* REDUCE TO 12 BITS AND OUTPUT CONTROL WORD 
SMOUT PSH A ;SAVE MSB 
AND A #$F8 ;CHECK FOR 
BEQ NSOV ;12 BIT 

CMP A #$F8 3;OVERFLOW 
BEQ NSOV 

PUL A ;OVERFLOW 

TST A ;SET TO 

BMI NGOV ;MAX 

ESOV LDA A #1 

STA A OVLD+2 

LDA A #$07 

LDA B #$FF 

BRA COUTP 

NGOV LDA A #2 

STA A OVLD+2 

LDA A #$08 

CLR B 

BRA COUTP 
NSOV CLR OVLD+2 

PUL A 
COUTP COM B 

STA A DA+2 ;OUTPUT IT 
STA B DA 

RTS 

* D(Z) CONTROL MODE 
DZC BSR DZCC 

JSR SMOUT ;OUTPUT IT 
BSR DZCD ;COMPUTE NEW G AND H 
RTS 

DZCC SUB B H+1 ;CALCULATE NEW X 
SBC A H 

STA A XO 

STA B XO+1 

* CALCULATE OUTPUT 

JSR FMLT 

FDB x0 

FDB AO 

LDX #G 

JSR DADD 

RTS 

* SHIFT DELAYED x'S 
DZCD LDX x2 

STX X3 

LDX X1 

STX X2 

LDX XO 

STxX x1 

* CALCULATE G FOR NEXT TIME 
LDA A DZN 

STA A DZNT 

GEE G 

CLR G+t1 

JSR FMLT 
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FDB X1 
FDB Al 
LDX #G 
JSR DADD 
DEC DZNT 
BEQ CALH 
JSR FMLT 
FDB X2 
FDB A2 
LDX #G 
JSR DADD 
DEC DZNT 
BEQ CALE 
JSR FMLT 
FDB X3 
FDB A3 
LDX #6 
JSR DADD 
CALH LDA A DZN 
STA A DZNT 
CLR A 
CLR H+1 
JSR FMLT 
FDB X1 
FDB B51 
LDX #H 
JSR DADD 
DEC DZ2NT 
BEQ GHX 
JSR FMLT 
FDB X2 
FDB B2 
LDX #H 
JSK DADD 
DEC DZNT 
BEQ GHX 
JSR FMLT 
FDB X3 
FDB B3 
LDX #5 
JSR DADD 


DUAL MODE CONTROLLER 
SET POINT CHANGE CAUSES 
DEADBEAT CONTROL FOR 
N+2 SAMPLE PERIODS 

AT SAMPLE TIME ONE 

AND THEN RETURNS TO 

PID AT SAMPLE TIME ZERO 
DZPC TST DZPFLG 

BEQ DZPC1 

TST DZPFLGt? 31S THIS D(Z) START? 
BNE DZPC2 ;NO 


eH UM H HH He He 
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INC DZPFLGt1 ;YES, SET FLAG 

LDX TMSV+2 ;CHANGE TIMER 

STX TIMER+4 ;TO TIME ONE 

[TZPC2 LEC DZPFLG 

JSR DZC ;RUN D(Z) CONTROL 

JSR PLEI ;UPDATE PID INTEGRATOR 


Ris 
CZPC1 TST DZPFLG+t1 
BEQ DZPCY 


CLR DZPFLG+1 ;CLEAR FLAG 
LDX TMSV ;AND RESTORE TIMER 
STX TIMER+4 3$TO TIME ZERO 
DZPC4 JSR PIDC 


RTS 

x 

* DOUBLE ADD 

* RESULT IN A,B AND 

* O,X AND 1,X 

*OA,ZB ADDED TO 0,X , 1,X 
* CARRY IS SEI ON OVERFLOW 
* AND RESULT IS SET TO MAX 
* 


DADD ADD B 1,X ;ADD LSB 

ADC A 0,X ;ADD MSB 

BVC DADD1 

BLT DADD2 

LDA A #$7F 

LDA B #$FF 

BRA DADD3 

DADD2 LDA A #$80 

CLR B 
DADD3 SEC 

BRA DADD4 

DADD1 CLC 
DADD4 STA A 0,X 

STA B 1,X 

RTS 

* 

* TABLE FOR CONTRCL MODES 
CNIBL FDB PIDC,[ZC,DZPC,TDBT, VALG, STM 
* 

* DUAL MODE CONTROLLER 

* USING TABLE LOOK UP FOR 

* OUTPUT VALUES 

TDBMT FDB AMO,AM1,AM2,AM3 ;TABLE FOR OUTPUTS 
TDBT TST DZPFLG ;PID AGAIN 

BEQ TDBT1 ;WAS LAST TIME DEAD BEAT? 
TST DZPFLG+1 ;IS THIS DEAD BEAT START? 
BNE TDBT3 

LDX TMSV+2 ;SWAP TIMER 

STX TIMER+4 ;TO TIME ONE 

INC DZPFLG+1 ;SET FLAG 

IDBT3 LDA B DZN 

SUB B DZPFLG 


96 


2acon soa tio | 


— a ee Ls be sr 


- depp) 
cons ya0s. Si at out a! 
, 4. : oat ia, a % ~ o a 
_atoatuo 20% S1080% | 1 SHA FA 4 08K re 
Traga 4 =a i - a P . Ee * 9 ‘- 
TTHsTS F 


INC B $B HAS NUMBER OF OUTPUT 
LDX #TDBMT 

JSR ULDE ;X POINT TO SUBROUTINE 
JSR 0,X ;CALCULATE OUTPUT VALUE 
JSR SMOUT ;OUTPUTL IT 

DEC DZPFLG 

JSR PLEI ;UPDATE PID INTEGRATOR 
BRA TDBT4 
IDBT1 TST DZPFLGt1 

BEQ TDBT2 ;GOTO PID 

CLR DZPFLG+1 

LDX TMSV ;RESTORE TIMER ZERO 
STX TIMER+4 
TDBT2 JSR PIDC 

IDBT4 PTs 

AMO JSR FMLT 

FDB PPX 

FDB AO 

RTS 

AM1 JSR FMLT 

FDB PPX 

FDB Al 

RTS 

AM2 JSR FMLT 

FDB PPX 

BDB AZ 

RTS 

AM3 JSR FMLT 

ED ERX 

FDB A3 

RTS 

* PUT LAST OUTPUT INTO THE PID INTEGRATOR 
PLEI LDA A DA+t2 

LDA B DA 

COM B 

STA A ISMPL 

STA B ISMPL+1 

RTS 

3K 

* THIS IS THE POSITIONAL STEPPER MOTOR CONTROL PART 
SIM TST A 
BNE ST2 

CMP B #$14 

BLS ST3 

BRA ST1 

ST2 CMP A #$FF 

BNE ST1 

CMP 5B #$EC 

BES Sid 

SESZPSHRA 

LDA A #TCR1 

STA A TIMER 

PUL A 

JSR PIDCC 


* a - — 
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JSR 
RTS 
st 1 
LDA 
STA 
PUL 
JSR 
PSH 
PSH 
AND 
BEQ 
CMP 
BEQ 
PUL 
TST 
BMI 
PSTM 
LDA 
BRA 
NSTM 
CLR 
BRA 
STMO 
STMO 
BMI 
LDA 
STA 
PUL 
BRA 
STM 1 
STA 
PUL 
COM 
COM 
ADD 
ADC 
STM2 
STaS 


* STOP WHEN THE NEXT TABLE ENTRY IS LARGER THAN A,B 


CMP 
SBC 
PUL 
BCS 
INX 
INX 
INX 
INX 
BRA 
STES 
STX 
JSR 


RTS 
* 


PIDCD 


PSH A 

A #TCR1 TOEN ; ENABLE THE TIMER OUTPUT 

A TIMER 

A 

PIDCC ;GET THE PID CONTROL 

A ;SAVE MSB 

A ;WE NEED If TWICE 

A #$F8 ;CHECK FOR 12 BIT OVERFLOW 

STMO ;GOOD 

A #$F8 ;OVERFLOW IF FIRST 5 BITS NOT SAME 
STMO ;GOOD 

A ;GET A BACK 

A ;SET TO 

NSTM ;MAX IF OVERFLOWED 

LDA A #$07 ;POSITIVE OVERFLOW 

B #$FF 

STMOO 

LDA A #$F8 ;NEGATIVE OVERFLOW 

B 

STMOO 

PUL A 

0 TST A 

STM1 ;CHECK IF If IS NEGATIVE 

A #1 

A OVLD ;PLUS DIRECTION FOR STEPPER 

A s;RESTORE A 

STM2 

CLR A 

A OVLD ;REVERSE DIRECTION FOR STEPPER 

A ;RKESTORE A 

A 
5 
B #1 3;WE NEED ABSOLUTE VALUE SO, 
#0 ;COMPLEMENT A,B 
LDX #SMTBL 
PSH A ;SAVE A 


YP 


B 5,X ;SUB M(X) FROM A,B 
Roly 

A ;GET A BACK 

STM5 3;M(X) IS BIGGER THAN A,B 


slRY THE NEXT ONE 

STEMS 

LDX 2,X ;GET THE TIMEOUT VALUE 
TIMER+2 ;OUTPUT NEW TIMER VALUE 

PIDCD ;CLEAN UP AFTER THE PID CONTROL 


* THIS IS THE TABLE FOR THE STEPPER TIMER 
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* THE FIRST TWO EYTES ARE THE VOLTAGE RANGE 
* AND THE NEXT TWO EYTES ARE THE CORRESPONDING 
* STEP TIME, ETC. 

SMTBL FDB $0000, $FFFF 

FDB $000A,$01F3 

FDB $000F,$014D 

FDB $0014, $00F9 

FDB $0029, $007C 

FDB $003D,$0052 

FDB $0052, $003E 

FDB $0066, $0031 

FDB $007B, $0029 

FDB $008F,$0023 

FDB $00A4,$001E 

FDB $00B8,$001B 

FDB $00CD, $0018 

FDB $00E1,$0016 

FDB $00F6, $0014 

FDB $010A,$0012 

FDB $011F, $0011 

FDB $0133,$0010 

FDB $019A,$000B 

FDB $0200,$0009 

FDB $0266, $0007 

FDB $02CD,$0006 

FDB $0333,$0005 

FDB $0400, $0004 

FDB $04CD, $0003 

FDB $0666,$0002 

FDB $07FF, $0002 

FDB $FFFF,$0002 

* END OF TABLE 

* 

* THIS IS THE VELOCITY STEPPER MOTCR CONTROL 
* If USES B3 FOR THE OVERALL GAIN CONSTANT 
VALG JSR PIDCC ;CALL PID CONTROL 
SUB B LCNTL+1 ;SUBTRACT THE LAST CONTROL 
SBC A LCNTL 

STA A LCNTL ;AND SAVE FOR MULTIPLY 
STA B ICNTL+1 

PSH A 

PSH B 

JSR SMOUT ;OUTPUT TO THE D/A ALSO 
PUL B 

PUL A 

JSR FMLT ; TIMES B3 

FDB LCNTL 

FDB B3 ;NUMBER OF STEPS PER VOLT 
DSTA 

BPL VALG1 ;IT IS POSITIVE 

COM A 

COM B 

ADD B #1 

ADC A #0 ;NEGATE A,B 
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PSH 
LDA 
AND 
STA 
PUL 
BRA VALG2 

ALG1 PSH A 


OVLD ;MAKE DIRECTION = 0 
#SFE 
OVLD 


mb me 


LDA A OVLD ;SET DIRECTION = 1 


ORA A #$01 

STA A OVLD 

PUL A 

ALG2 TST A 3;IS If SATURATED? 
BEQ YVALG3 


LDA B #$FF 
VALG3 STA B STEPS 
LDA A #fTSTC TICR TOEN 


STA A TIMER ;START PULSES TO MOTOR 


JSR PIDCD ;CLEAN UP PID 
RTS ;EXIT 


THIS ©1S THE MIDDLE ADDRESS ROM 
ORG $C800 


THIS IS A ROUTINE FOR THE QUICK 
MULTIPLICATION OF TWO 16 BIT NUMBERS 
ONE OF WHICH IS IN FLOATING POINT 


THE FLOATING POINT NUMBER IS CALLED MPLY 
AND IS IN THE FOLLOWING FORMAT 

BYTE 0 BIT 7 IS THE MANTISSA SIGN 

BITS 6-0 ARE THE TWOS COME CHARACTERISTIC 
BYTES 1,2 IS THE BINARY MANTISSA 


THE BINARY NUMBER IS CALLED MCND 
AND IS IN THE FOLLOWING FORMAT 
BY OFFS ZHEOMSS 

BYTE 1° 1S THE USB 


THE RESULT IS RETURNED IN A AND B (MSB,LSB) 
THE CARRY BiT WILL BE SET IF OVERFLOW OCCURED 


NO REGISTERS ARE SAVED 

THE CALLING SEQUENCE I5; 

JSR FSMT 

FDB MCND 

FDB MPLY (MULTIPLIER AND MULTIPLICANT ADDRESSES) 
KETURN 


THE CODE IS REENTRANT, ALL INTERMEDIATE 
VALUES ARE HELD ON THE STACK 


DURING EXECUTION THE STACK APPEAES 


;B HAS NUMBER OF STEPS FOR MOTOR 
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* STACK POINTER 

* CNT (THE CYCLE CCUNTER) 
* MCSIGN 

* MPSIGN 

* CHAR (MPLY) 

* MSB 

* LSB 

* MSB  (MCND) 

* LSB 

* RETURN MSB 

* RETURN LSB 

* 


+ 


MOVE JMP MOVER ; ENTRY FOR MOVE ROUTINE 
GHDIN JMP GHD ;ENTRY FOR HEX DIGIT GETTER 
KININ JMP KINEN ;ENTRY FOR HEX TO DECIMAL 
STRT JMP START ;THE RESET SEQUENCE 

AK AK AK Ae A eK A A A 2 ak He ee ak Oh ak ae a Ae a 2k a ae ak a ik 2k 2 ok 

* GET ARGS AND SET UP STACK 

OK OK EK OK OK IK KK ie a ke aK a i ae a 2c ae ak ok ie oe ok a a oe 3K aK 2 aK ok OK 

FMLT TSX 

LDX 0,X ;GET ADDRESS OF FDB 

LDX 0,X ;GET MCND ADDRESS 

LDA A 1,X ;PUT MCND ON STACK 

PSH A 

LDA A 0,X 

PSH A 

% 
TSX ;PUT MPLY.ON STACK 
EDN 2 

LDX 2 

LDA A 

PSH A 

LDA A 

PSH A 

LDN 2907s 
PSH A 

CLR A 

PSH A 

PSH A 

LDA A 

PSH A 

TSX § 

% 

ASLESEX 
BCC MBN 
THC 25x 
* 

MBN TST 6,X ;MAKE MCND BINARY AND 
BPL ROMM ;SAVE SIGN ON STACK 

INC 1,X 

LDA A 6,X 

LDA B 7,X 

COM A 


s;CLEAR SOME SPACE ON STACK 


#16 316 CYCLES OF SHIFT 
X POINTS TO STACK 


3;GET SIGN OF MPLY 


anrrvod. #A 
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1,X ;SIGN OF RESULT IN MCSIGN 


CLEAR FOR OVERFLOW SIGN 


ADC A 6,X 


4 
ROR 5 
DEC 0 
BNE R 
* 

PSH A ;PUT 10 IN CNT FOR INCREMENTING 

LDA A #10 ;STACK POINTER AT END 

STA A OQ 

PUL A 
ok 


* GET CHAR IN TWO*'S COMP. SIGN IS ALREADY STRIPPED 
* 

MPL ASR 3,X 

BEQ MNEND ;NO SHIFTS IF EXP 0 
BPL MLSH 

MRSH BSR RSH ;SHIFT RESULT RIGHT 
BSR RSH ;ON NEGATIVE EXP 

BSR BSH , 

BSR RSH 

ERG,3;X 

BNE MRSH 

BRA MNREND 
RSH LSR A 

ROR B 

ROR 4,X 

RTS 
MLSH BSR LSH ;SHIFT RESULT LEFT ON 
BSR LSH ;POSITIVE EXP 

BSR LSE 

BSR LSH 

DEC 3,X 

BNE MLSH 
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MNEND 


LSH ASL 5,X 


ROL 
ROL 
ROL 
BPL 
INC 


ESiTt 
* 


4,X 

B 

A 

LSXT ;SET OVERFLOW 
2X 

RTS 


MNREND TST 4,X ;SHALL WE ROUND? 


BPL 
ADD 
BCC 
INC 
MSGN 
BEQ 
COM 
COM 
ADD 
ADC 


MSGN ;NO 

B #1 

MSGN 

A 

TST 1,X ;CHECK SIGN OF RESULT 
OP 

A ;COMPLEMENT IF NEGATIVE 

B 

B #1 

A #0 


ISP INS ;INCREMENT SP AND RETURN 


DEC 
BNE 
TST 
BEQ 
SEC 
BRA 
NXOV 
FMXT 
JMP 


eH He wm HH HH HH 


0,X 
bor 
2X 3;SET CARRY IF OVERFLOW OCCURED 
NXOV 


EMXT 
CLC 
LDX 8,X 
4,X 


THIS IS A GENERAL PURPOSE 
BLOCK MOVE ROUTINE 

THE CALLING SECUENCE IS 
LDX #DESTINATION 

JSR MOVE 

FCB BYTE COUNTER 

FDB 
RETURN 


SOURCE ADDRESS 


MOVER STX TDST ;SAVE DESTINATION 


TSX 
LDX 
LDA 
LDX 
sTx 
MVLP 
INX 
oTxX 
LDX 
STA 
INX 
STX 
LDX 


*X POINTS TO BYTE COUNTER 
7X :B IS BYTE COUNTER 
sGET SOURCE 
C :AND SAVE 
A 0,X ;MOVE IT ALL 


0,X 
B 0 
1,X 
TSR 
LDA 
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DEC 
BNE 
TSX 
L DX 
INS 
INS 


JUMP 
* 
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B 
MVLP 


;RESTORE THAT STACK 


3,X ;RETURN 


* GET DISPLAY AND SEND IT TO HEX TRANSLATOR 
*ESETRIRE CARRY IF EXPONENT IS GT 3 OR if -3 
GHD LDX #KIND 


LDA A #RDAI ;AUTOINC READ OF DISPLAY 
STA A KDSPt1 

LDA B #6 36 DIGITS 

GHD1 JSR SVNSE 3;GET DIGIT 

SPACREZO PX 

INX 

DEC 5 

BNE GHD1 

CMP A #3 ;A HAS THE EXPONENT 

BGT GHDE ;AND IT CAN*T BE GT 3 

CMP Av#-3 ;OR LESS THAN =3 

BLT GHDE 

JSR KINEN ;KINHF 0-2 HAS RESULT IN HEX 
CLC ;NO CARRY IF NUMBER GOOD 

RTS 
GHDE SEC ;SET CARRY IF EXP CUT OF RANGE 
RTS 

* 

3 

* THIS IS THE ROUTINE TO TRANSLATE 

* BCD FLOATING INPUT TO HEX FLOATING 
* THE ALLOWED RANGE IS 

* 0.001 X 10**-3 TO 0.999 X 10**3 

od 

* THE KEYBOARD ENTRY MUST BE 

* ENTERED INTO KIND AS FCLLOWS; 

* KIND SIGN 

* MSB 

* ISB 

* LSB 

* EXP SIGN 

* EXP 

x 

* CLEAR SOME SCRATCHPAD 

* THIS IS ALSO ENTRY POINT 


KINEN CLR A 


ORA 
ORA 
ORA 
BNE 
STA 
Sak 
STA 


A KIND+1 ;FIRST SEE IF ZERO 
A KIND+2 

A KIND+3 

KIN7 

A KINHF 

A KINHF+1 

A KINHFt2 


sek? 7) sh ae 
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CLR 
CLR 
CLR 
RIS 
KIN7 
LDA 
KI NO 
INX 
DEC 
BNE 


IN 


% HH He H 


KIND 
KIND+4 
KIND+t5 


LDX #KINI 
A #9 
CLR 0,X 


A 
KINO 


FIND LOCATION TO PUT DIGITS 


KINI, THE INTEGER TABLE 


AFTER MULTIPLY BY 10 EXP 6 


KIN LDA A #3 ;ADD 3 TO EXP 


TSt 
BMI 
ADD 
BRA 
KIN1 
LDX 
KIN2 
BEQ 
DEX 
DEC 
BRA 
KIN3 
STA 
LDA 
STA 
LDA 
STA 
* 


KIND+4 

KIN1 

A KIND+5 

KiIN1+2 

SUB A KIND+t5 

#KINI+6 ;POINT TO LSB OF TABLE -3 
TST A 

KIN3 ;MOVE DIGIT WHEN EXP=0 


A 
KiN2 

LDA B KIND+1 :MOVE DIGITS 
B 0,X ;INTC 

B KIND+2 ;TABLE 
B1,X 

B KIND+3 
BY2Sx 


* CONVERT INTEGER DECIMAL 
* INTO INTEGER BINARY 

* USING ADD AND TIMES 

* TEN ALGORITHM 


LDA 
LDX 
KIN4 
INX 
DEC 
BNE 
LDA 
LDX 
KIN5 
ADD 
STA 
LDA 
ADC 
STA 
LDA 
ADC 


A #4 ;CLEAR RAM 
#KINB 
CLR 0,X 


A 

KING 

A #9 ;DO 9 DIGITS 

#KINI ;POINT TO MSB OF INTEGER 

LDA B 0,X ;ADD NEXT DIGIT 
KINBt3 
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STA B KINB+1 

LDA B KINB 

ADC B #0 

STA B KINB 

INX ;GET NEXT DIGIT 
DEC A 

BEQ KIN6 ;DONE? 


* IF NOT, MULTIPLY BY TEN 


STX XTEMP ;SAVE KINB 

LDX KINB ;IN KINBT 

STX KINBT ;TO BE ADDED 

LDX KINB+2 

STIX KINBI+t2 ;LATER 

LDX XTEMP 
* MULTIPLY BY TEN 

LDA B #2 3;TWO SHIFTS=TIMES 4 
BSR KINSL 


LDA B KINB+t+3 
ADD B KINBT+3 
STA B KINB+t3 
LDA B KINBt2 
ADC B KINBT+2 
STA B KINBt+2 
LDA B KINB+1 
ADC B KINBT+1 
STA B KINB+1 
LDA B KINB 
ADC B KINBT 
STA B KINB 
LDA B #1 ;ONE MORE SHIFT 
BSR KINSL 


BRA KINS5 ;DONE 
KINSL ASL KINB+3 
ROL KINB+t2 

ROL KINB+1 

ROL KINB 

DEC B 

BNE KINSL 

RTS 
* 


* NOW WE MULTIPLY BY HEX 10C7 X 16**-8 
* 
KIN6 LDA A #8 ;FIRST CLEAR STACK ROOM 
CLR B 
CLSP PSH B 
DEC A 
BNE CLSP 
LDA A #48 ;48 CYCLES 
PSH A 
TSX 
* DO MULT 
* 0,X IS CYCLES 


106 


Pee Le SA 
ABTS a a 


- be 


: g-seat X Poot aH Le rsaeie i, 
KOOn n2are Aaa bye ata a 
ao te > a. Lat 
’ ; 
7 Xe : 
=} . 


107 


* 1,X IS MSB OF RESULT 

* 2,X IS NEXT, THEY ARE TEMP IN A,E 
* ETC TO 8,X WHICH IS LSB 

* 


CLR A 

CLR B 

KINM LSR KINB 

ROR KINE+1 ;TEST 
ROR KINBt2 ;NEXT 
ROR KINB+3 ;BIT 


ADC A #$10 
KINM1 ROR A 
ROR 
ROR 
ROR 
ROR 
ROR 
ROR 
ROR 
DEC 
BNE 
STA EX 

STA B 2,X 

* FORMAT THE RESULT 

LDA A #10 

KINF INX ;POINT TO MSB OF ANSWER 
DEC A 

DEC A 

TST 0,X ;FIND THE NON-ZERO DIGIT 
BEQ KINF 

* NOW SEE WHICH NIBBLE IS NON-ZERO 
LDA B #$FO 

AND B O,X 

BEQ KINF1 ;NOT THAT ONE 

KINF3 LDA B 2,X 

STX XTEMP 

LOXAOSX 

TST B 

BPL KINF2 ;SHALL WE ROUND? 

INX 
KINF2 STX KINHF+1 

LDX XTEMP 

BRA KINFE 

KINF1 LDA B #4 ;SHIFT 4 PLACES LEF1 
KINF4 ASL 2,X 

ROL 1,X 

ROL 0,X 

DEC B 

BNE KINF4 

DEC A 

BRA KINF3 

* NOW ADD SIGN AND STORE EXP 
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KINFE ASL A 
LDA B KIND 
ASL B 
ROR A 
STA A KINHF 

* 


* RESTORE STACK POINTER 

* 

LDA A #9 

RSSP INS 

DEC A 

BNE RSSP 

RTS 

*k 

START LDS #$03FF 

LDX #$03FF 

STLP CLR 0,X 

DEX 

BNE STLP 

LDX #$0401 ;START STEPPER TIMER AT 10 MSEC 
STX TSTP 

INC STTMD#+2 ;SET DISPLAY DIGIT FOR 10 MSEC 
INC DZN ;START AT ORDER 1 D(2Z) 

LDA A #$34 ;DIVIDE DISPLAY CLOCK BY 20 
STA A KDSP+1 

CLR KDSP+1 ;LEFT ENTRY OF 8 DIGITS 

LDX #DA 

LDA B #4 ;PA1 AND PB1 ARE OUTPUTS 


Com 0,x 

STA B 1,X 

COM 2,X 

STA B 3,X 

STA B 9,X ;PA3 ARE INPUTS 
LDA B #$2E ;PULSE CB2 


STA B 11,X ;USE RISING EDGE OF CB1 
INITIALIZE THE TIMER CHIP 

TIMER 3°)1S USED TO GENERATE 1 MSEC 

COUNT INTERVALS WHICH ARE USED BY 

TIMERS 2 AND 3 TO GENERATE INTERRUPTS 

IN STEPPER MOTOR CONTROL TIMER 1 IS USED 
INSTEAD OF TIMER 2 TO GENERATE INTERRUPTS 
LDA #TCR3 

STA TIMER 
LDA #TCR2 TICR ;INTERRUPTS FROM TIMER 2 
STA TIMER+1 
LDA #TSTC ;CONTRCL TIMER 1 FOR STEPPER 
STA TIMER 
LDX #$01F3 

STX TIMERt+6 ;USE TO GENERATE 1 MSEC COUNTS 
* INITIALIZE THE OVERLOAD PIA 

LDA A #1 3;PAO IS OUTPUT 

STA A OVLD 

LDA A #$2C ;CA2 IS PULSES 10 STEPPER MOTOR 
STA A OVLD+1 
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COM OVLD+2 

LDA B #4 

STA B OVLD+3 

JSR CLDSE ;CLEAR THE DISPLAY 

CLR SPFN ;GET THE FIRST BUTTON TOO 
CLI 

JMP BIST 

* 

* THIS IS THE HIGHEST ADDRESS ROM 
ORG $CCO00 

5 

ULDE JMP ULD ;ENTRY POINT FOR ULD 
SVNSE JMP SVNS ;SEVEN SEGMENT DISPLAY ENTRY POINT 
CLDSE JMP CLDS 

* 

ETST BSR BTWT 

TST SPFN ;ANY FUNCTIONS 

BNE BTST1 ;LAST TIME ? 

JSR NFND1 
BTST1 CLR SPFN 

BRA BIST 
x 


* BUTTON SERVICE ROUTINE 

x 

BIWE LDA A KDSP+1 ;TEST FOR 
AND A #$07 ;BUTTONS 

BEQ BIWT 

LDA A #RB ;GET BUTTON 

STA A KDSP+1 ;IN 

LDA ;REGISTER B 

AND 
CMP B #$00 ;IS IT CLEAR FUNCTION? 
BNE NLK 

JSR CLDS 

SEC ;SET CARRY TO CANCEL FUNCTION 
RTS 

NLK LDX #NTBL 

LDA A #11 311 TRIES, 0-9, - 

NSCH CMP B 0,X ;SCAN TABLE FOR 

BEQ NFND ;NUMBER 

INX 

INX 

INX 

DEC A 

BNE NSCH 

* IF BTWT WAS CALLED FROM FUNCTION 
* WE CANT ALLOW ANOTHER FUNCTION 

* TO BE CALLED 

TST SPFN 

BEQ FSCH1 

JSR FERRS 

SEC ;CANCEL FUNCTION 

RTS 
FSCH1 LDX #FTBL ;MIGHT BE ONE OF 
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LDA 
FSCH 
BEQ 
INX 
INX 
INxX 
DEC 
BNE 
RTS 
FFND 
INC 
JSR 
NFND 
RTS 


A #11 311 FUNCTION BUTTONS 
CMP B 0O,X 
FFND 


A 
FSCH 


LDX 1,X ;CALL FUNCTION 
SPFN ;DON'T CALL DISPLAY 
0,X 

CLC 


* DISPLAY NUMBER 


NFND1 LDA B 2,X ;GET SEVEN SEGMENT 


LDA 
INC 
CMP 
BLT 
CLR 
BRA 


A DCTR 
A 

A #6 
NFND2 
A 
NFND3 


NFND2 CMP A #4 


BEQ 
CMP 
BNE 
CLR 
DEC 
BRA 


NFND3 
B #$40 
NFND4 
B 
A 
NFNDX 


* A HAS ADDRESS OF DISPLAY 
* B HAS DATA 
DSPOUT TST A ;SET DECIMAL 


BNE 
ORA 
DCPT 
STA 
STA 
RTS 


DCPT ;iN 

B #$80 ;FIRST DIGIT 
ORA A #WD 

A KDSP+1 

B KDSP 


NFND4 BSR DSPOUT 


BRA 


NF NDX 


NFND3 CMP B #$40 ;IS IT - SIGN? 


BEQ 
PSH 
CLE 
JSR 
INC 
PUL 
BRA 


NFND4 
B 

B 
DSPOUT 
A 

B 
NFND4 


NFNDX AND A #$07 
STA A DCTR 


RTS 
* 


* FCB IS 8279 BUTTON CODE 
* FDE IS BINARY AND 7 SEGMENT CODE 
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NTBL 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 

FTBL 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 
FCB 
FDB 


FCB $02 

$003F 

SOA 

$0 106 

$09 

$025B 

$08 

$0 34F 

$12 

S$O466 

$11 

$056D 

$10 

$0€7D 

$1A 

$0707 

$19 

$087F 

$18 

$096F 

$01 

$8040 ;MINUS SIGN 

FCB $0B 

LOAD ;ENTER K 

$03 

DKP ;DISPLAY K 

$OC 

LDST ;LOAD SAMPLE TIME 
$O4 

DSST ;DISPLAY SAMPLE TIME 
$15 

CLIC ;CLEAR INTEGRATOR 
$13 

DSCM ;DISPLAY CONTROL MODE 
$1C 

LDZN ;LOAD D(Z) ORDER 
$14 

DSZN ;DISPLAY D(Z) ORDER 
$1B 

LDCM ;LOAD CONTROL MODE 
$0 D 

STPT ;LOAD SET POINT 
$05 

DSPT ;DISPLAY SET POINT 


* END OF TABLE FOR FUNCTIONS 


* 
* 


* LOAD CONTROL MCDE 


LDCM 
BCC 
RTS 
LDA 
BMI 
BRA 


JSK BIWT 
*+3 


B 1,X ;GET BINARY 
LDCME ;ERROR IF A MINUS SIGN 
LDCM1 ;GO LOAD IT 
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LDCME JSR FERR4 ;NOT A VALID CONTROL MODE 
RTS 
LDCM1 CMP B #5 ;CCNTROLS FROM 0 TO 5 
BHI LDCME 

STA B CNTMD 

BRA DSCM 

* LOAD D(Z) ORDER 

LDZN JSR BIWT 

BCC *+3 

RTS 

UDA BEIM 

BMI LDCME ;ERROR IF A MINUS SIGN 
BEQ LDZN2 

CMP B #4 

BLT LDZN1 
LDZN2 JSR FERRY 

RTS 

LDZN1 STA B DZN 

BRA DSZN 

* DISPLAY CONTROL MODE 

DSCM BSR CLDS ;CLEAR DISPLAY 

LDA A #WDAI ;PREPARE TO WRITE DISPLAY 
STA A KDSP+1 

LDA B #%01011000 ;WRITE A SMALL C 
STA B KDSP 

LDA B CNIMD ;WRITE CONTROL MODE 
JSR BTSV 

RTS 

* 

* DISPLAY D(Z) ORDER 

DSZN BSR CLDS ;CLEAR DISPLAY 


LDA A #WDAI ;PREPARE TO WRITE DISPLAY 
STA A KDSPt1 

LDA B #%01011100 ;WRITE A SMALL D 

STA B KDSP 

LDA B DZN ;WRITE THE D(Z) ORDER 

JSR BISV 

RTS 


ok 
* CLEAR THE DISPLAY 
CLDS INC SPFN 

LDA A #CD 

STA A KDSP+1 ;CLEAR 

CDC LDA A #5 ;DISPLAY 

STA A DCTR 
CDCW TST KDSP+1 ;WAIT FOR IT 

BMI CDCW ;TC HAPPEN 

RTS 

x 

* CLEAR INTEGRATOR INITIAL CONDITIONS 
CRITE: EDX #0 

STX ISMPL 


RTS 
x 
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* ERROR NUMBERS 


FERRO CLR 


BRA 


FERR1 LDA 


BRA 


FERR2 LDA 


BRA 


FERR3 LDA 


BRA 


FERR4 LDA 


BRA 


FERR5 LDA 


BRA 
” 


B 
FERR 
B #1 
FERR 
B #2 
FERR 
B 


FERR 


FERR 
B #5 


FERR 


* DISPLAY ERROR 


FERR 
PSH 
LDA 


SA. 


LDA 
LDX 
ERLP 
STA 
INX 
DEC 
BNE 
PUL 
BSR 
RTS 


JS CLDS 
B 

A #WDAI 

A KDSPt1 
A #3 
#ERTB 

LDA B 0,X 
B KDSP 


A 
ERLP 
B 
BISV 


FIRST CLEAR THE JUNK AWAY 


* THIS IS THE VECTOR TO WRITE 


oe 


"ERR? 


iN THE 


DISPLAY 


ERTB FCB $79,$50,$50 


x 


SEGMENT 


ROUTINE TO OUTPUT SEVEN 
DISPLAY FROM 
BINARY CONTENTS OF B 


B 


X AND A 


TSV PSH A 
STX PPX 

LDA A #17 
LDX #NTBL 


ARE SAVED 


ETSLP CMP B 1,X 


BEQ BISEN 
INX 

INX 

INX 

DEC A 

BNE BISLP 


BTSFN LDA B 2,X 


PUL A 

LDX PPX 
STA B KDS 
RTS 
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* ROUTINE TO DISPLAY K'S 

DKP JSR BIWT 

BCC ¥*+#3 

RTS 

LDA B 1,X 3;GET BINARY 

BMI DKPE 

LDX #COTBLT 

BSR ULD 

* ALSO ENTRY FOR OTHER DISPLAY PROGRAMS 
DKP1 LDA A #WDAI ;AUTOINC WRITE 
STA A KDSP+1 ;TO DISPLAY 

INC DCML ;ADD DECIMAL 

BSR DKP3 ;AND DISPLAY BLANK OR - 
LDA A #3 

BSR DKP4 

BSR DKP3 

LDA A #1 

BSR DKP4 

RTS 
DKP3 CLR B 

TST 0,X 

BPL DKP2 

LDA B #$40 
DKP2 TST DCML 

BEQ DKP21 

ORA B #$80 ;ADD DECIMAL 

CLR DCML 

DKP21 STA B KDSP 

INX 

RTS 
DKP4 LDA B 0,X 

BSR BISV 

INX 

DEC A 

BNE DKP4 

RTS 
DKPE JSR FERRO 

RTS 

* 
* UTILITY ROUTINE FOR LOAD AND DISPLAY 
* ADD 2 TIMES B TO X AND MAKE X 
* POINT TO DESIRED K 

ULD OTST B 

ULD2 BEQ ULD1 

INX 

INX 

DEC B 

BRA ULD2 

ULD1 LDX 0,X 

RTS 

ss 

COTBL FDB KP,KI,KD,A0,A1,A2,A3,B1,B2,B3 


YASU2IG GA GAOL Boe, uC a 
; k SAAR CHA X or cas : 


COTBLT FDB KPT, KIT,KDT,AOT, AIT, A2T, A3T,B1IT,B2T,B3T 
x 

* ROUTINE TO LOAL COEFFICIENTS 
* INTO STORAGE FROM THE 

* DISPLAY RAM 

LOAD JSR BIwt 

BCC *+3 

RTS 

LDA B 1,X 3;GET COEFF. NO. 

BMI LOADE 

PSH B ;WE NEED IT AGAIN LATER 
PSH B ;TWICE 

JSR GHDIN ;GET HEX FROM DISPLAY 
BCC LOAD1 ;IF CARRY IS SET EXP WAS OUT OF RANGE 
PUL B ;SO WE RESTORE STACK 

PUL B ;AND PRINT ERROR MESSAGE 
JSR FERR1 

RTS ;AND EXIT 
LOAD1 PUL B 

* MOVE COEFF INTC STORAGE 

LDX #COTBL 

BSR ULD 

SEI 

JSR MOVE 

PCB 3 

FDB KINHF 

CLI 

* SAVE DISPLAY 

PUL B 

LDX #COTBLT 

BSR ULD 

JSR MOVE 

FCB 6 

FDB KIND 

JSR CLDS ;CLEAR DISPLAY 

RIS ;AND RETURN 

LOADE JSR FERRO 

RTS 


ROUTINE TO SCAN TABLE FOR 

7 SEGMENT DISPLAY AND 

RETURN BINARY NO IN A 

CARRY IS SET if NO ENTRY FOUND 
80 IS RETURNED IF - SiGN FOUND 
ROUTINE GETS SEARCH VALUE 

FROM THE DISPLAY RAM, WHICH 
HAS ALREADY BEEN SET UP 

FOR AUTO INCREMENT 

B IS PRESERVED AS WELL AS X 

N 1S SET IF - SIGN RETURNED 


HMHeHeHeHH KH HH HH 


SVNS PSH B 
STX PPX 
LDA 5B KDSP ;GET DISPLAY 


q97% S57 wae, 
‘tn F 

4 wr of 
qevol TiT¥a OF ax: fee 

nm aquuoi Hole ~ 4X GEaaUyT 


AND 
LDA 
LDX 

SSRC 
BEQ 
INX 
INX 

—INX 
DEC 
BNE 
SEC 
BRA 

SVEN 
LDA 

SVND 
TPA 
LDX 
TAP 
PUL 
PUL 


RTS 
* 


B #$7F 
A #17 
#NTBL 


sMASK OFF DECIMAL 
71 2ATRIES 


CMP B 2,X ;SCAN THE TABLE 
SVEN ; FOUND IT 


A 
SSRC 


SVND 
CLC 
A 1,X 
PSH A 


PPX 
A 
B 


RETURN BINARY 


* ROUTINES TO LOAD SAMPLE TIME 
* FROM KEYBOARD IN MS 


# 


* HEX 1000 CONSTANT 
STCN FDB $03E8 
* 


LDSTB JMP LDSTE 
JSR BIWT ;FIND WHICH TIME 


LDST 
BCC 
RTS 
LDA 
PSH 
BMI 
CHP 
BEQ 
CMP 
BHI 
JSR 
BCS 
ASL 
LSR 
CLR 
JSE 
FDB 
FDB 
BCS 


*+3 

> ERROR 

B 1,X ;GET BINARY NUMBER 

B ;SAVE iT 

LOUSTB ;NEGATIVE BAD 

BUe25;IS IT FOR THE STEPPER? 
STTM 

B #1 ;MUST BE 0 OR 1 NOW 
LDSTE 

GHDIN ;GET HEX FRCM DISPLAY 
LDSTE2 ;EXP OUT OF RANGE IS CARRY SET 
KINHF ;MAKE POSITIVE 

KINHF 

KIND 


FMLT ;MULT BY 1000 
STCN ;TO GET MSEC 


KINHF 
LDSTE2 


* NOW CHECK IF OUT OF RANGE 
A ;IS A,B LT 10 MSEC 


fSD 
BNE 
CMP 
BCS 
BRA 


LDST1 
B #10 
LDSTE2 
LDST2 


;A IS NOT ZERO 
70S B-LT110 


;iT IS GOOD 
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LDST1 CMP A #$75 ;1S A,B GT 30 SEC? 
BHI LDSTE2 ;BAD IF GT 


BNE 
CMP 
BHI 


LDST2 ;IT IS GOOD 
B #$60 ;BAD IF GT 
LDSTE2 


LDST2 SUB B #1 ;LOAD TIMER 


SBC 
TSX 
Se 
INS 
BNE 
STA 
STA 
STA 
STA 
LDX 
BRA 


A #0 


C72 315 THIS TISER 0 OF 1 
sRESTORE STACK 

LDST3 

A TIMER+4 

B TIMER+5 

A TMSV 

B TMSV+1 

#SMPT ;SAVE DISPLAY 
LDST4 


LDST3 STA A TMSV+2 


STA 
LDX 


B IMSV+3 
#SMPTT 


LDST4 JSR MOVE 


FCB 
FDB 
JSE 
RTS 
SsTIM 
BCS 
ASL 
LSR 
CLR 
JSR 
FDB 
FDB 
BCS 
£St 
BNE 
CMP 
BLS 
DEC 
LSR 
STA 
LDX 
INS 
BRA 


6 
KIND 
CLDS 


JSR GHDIN ;GET HEX FROM DISPLAY 
LDSTE2 ;INPUT ERROR 

KINHF ;MAKE POSITIVE 

KINHF 

KIND 

FMLT ;MULTIPLY BY 1000 

STCN ; TO GET MSEC 

KINHF 

LDSTE2 ;O0UT OF RANGE 

A ;CHECK FCR RANGE 

LDSTE2 

B #5 

LDSTE2 ;LESS THAN 6 MS IS TOO FAST 
B 

B ;DIVIDE BY 2 

B TSTP ;SAVE FOR STEP TIMER 
#STIMD ;SAVE DISPLAY 

RESTORE STACK 

LDST4 


LDSTE PUL B 


JSR 
RTS 


FERRO 


LDSTE2 PUL B 


JSR 
RTS 
* 


FERR2 


* CONSTANT FOR 12 BIT CONVERSION 


IWBC 
FDB 


FCB $00 
$1996 
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LOAD THE SET POINT 
THE RANGE IS -10 TO +10 VOLTS 
A VALUE LESS THAN 4.88 MVOLTS IS ERROR 
STPT JSR GHDIN ;GET IN HEX FROM THE DISPLAY 
BCS STPTE ;EXP OUT OF RANGE IF CARRY SET 
LDA A KINHF ;GET EXP 

ASL A ;STRIP MANTISSA SIGN 

ASR A 

DEC A 

BGT STPTE ;EXP TOC BIG FOR SET POINT 
CMP A #-2 

BLT STPTE ;EXP TOO SMALL FOR SET POINT 
STPT5 INC A 

BGT STPT2 | 

LDA B #4 ;NOW WE DO THE HEX SHIFTING 
STPT1 LSR KINHF+1 

ROR KINHF+2 

DEC B 

BNE STPT1 

BRA STPT5 

* GET RID OF SIGN BIT 
* SINCE THIS IS UNSIGNED BINARY 
* DIVIDE BY TWO 

STPT2 LSR KINHF+1 

ROR KINHF+2 

LDA A #$50 ;HEX CANT BE GT 5000 

CMP A KINHF+1 

BCS STPTE 

BHI STPT3 

TST KINHF+2 

BNE STPTE 
* MULTIPLY BY 0.1996 TO GET 12 BIT 
STPT3 JSR FMLT ; NUMBER IS OK 

FDB KINHF+1 ;RESULT IN A,B 


HHH & 


FDB TWBC 

TST KINHF ;CHECK SIGN 

BFL STPT4 

COM A 

COM B 

ADD B #1 

ADC A #0 

STPT4 PSH B 

PSH A 

SUB B SETPNI+1 

SBC A SETPNT ;GET DIFFERENCE 
STA A PPX ;AND SAVE IN PPX 
STA BEB PPX+1 

PUL A 

PUL B 

STA A SETPNT ;SAVE IT 

STA B SETPNT+1 

LDA A #4 3;SET BUMPLESS FOR 4 TIMES 
STA A BMPFLG 
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LDX #SETPD ;SAVE DISPLAY 
JSR MOVE 

FCB 6 

FDB KIND 

LDA A DZN 

INC A 

STA A DZPFLG ;SET FOR Nt+t2 LEADEBEAT 
JSR CLDS 

RTS 

STPTE JSR FERR3 

RTS 

* 


* DISPLAY SAMPLE TIME 
* 
DSST JSR BIWT 

BCC ¥*+3 

RTS 

EDA) Boy x 

BMI DSSTE 

BEQ DSST1 

CMP B #2 ;IS IT FOR STEPPER? 
BEQ DSST3 

CMP B #1 

BNE DSSTE 

LDX #SMPTT 

BRA DSS@2 
DSST1 LDX #SMPT 
DSST2 JSR DKP1 

RTS 
DSSTE JSR FERRO 

RTS 
DSST3 LDX #STTMD 

BRA DSST2 

ok 

* DISPLAY SET POINT 

*K 

DSPT LDX #SETPD 

JSR DKP1 

RTS 

* THESE ARE THE INTERRUPT AND 
* START VECTORS 

ORG $CFF8 

FDB CNTLP,CNTLP,CNTLP,STRT 
END 
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